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Abstract 

The  Starfire  Beam  Director  (SBD)  is  located  at  the  Starfire  Optical  Range  at 
Kirtland  Air  Force  Base  in  Albuquerque,  New  Mexico.  The  SBD  capabilities  include 
tracking  celestial  objects  and  active  or  passive  tracking  of  artificial  satellites  to  support 
the  Phillips  Laboratory  Ground  Based  Laser  Acquisition,  Tracking,  and  Pointing  (GBL 
ATP)  program.  The  pointing  and  tracking  accuracy  needed  to  support  such  experiments 
is  microradian  to  sub-microradian  level.  To  accomplish  this  goal  requires  precise 
pointing  of  the  massive  6  ton  1 -meter  clear  aperture  coelostat1. 

The  purpose  of  this  thesis  is  to  use  optimal  control  design  techniques  to  develop  a 
controller  to  meet  the  stringent  pointing  requirements.  A  nominal  linear  state-space 
model  was  built  which  included  gimbal  dynamics,  plant  disturbances,  and  sensor  noise. 
Then  optimal  design  techniques  were  used  to  develop  unity  feedback  and  two  degree  of 
freedom  controllers.  The  various  controllers  were  simulated  with  the  coelostat  "truth" 
model,  which  incorporated  the  higher  frequency  current  loop  and  motor  dynamics,  non- 
linearities,  plant  disturbances,  sensor  noise,  and  discrete  control  effects.  The  best  of  the 
designs,  the  H2  unity  feedback  controller,  was  compared  and  contrasted  with  the 
performance  of  the  controller  currently  being  used,  which  was  obtained  by  classical 
control  design.  The  H2  controller  exceeded  tracking  requirements  and  in  most  areas 
performed  better  than  the  current  controller. 


1  Coelostat  refers  to  a  two-mirror  beam  director  gimbal. 
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OPTIMAL  CONTROL  OF  THE 
STARFIRE  BEAM  DIRECTOR 


I.  Introduction 


1.1  Background 

The  background  discussion  is  intended  to  be  a  generic  description  of  the 
acquisition,  pointing,  and  tracking  (ATP)  functions  of  a  beam  director.  Most  beam 
directors  have  ATP  systems  and  procedures  that  are  slightly  different  from  this 
description,  but  the  general  process  and  terminology  is  the  same. 

The  term  "beam  director"  is  generally  intended  to  describe  a  device  which  takes  the 
output  of  a  stationary  laser  device  and  transmits  it  in  a  arbitrary  direction.  To  accurately 
illuminate  an  object  with  a  laser  beam  the  object  must  be  tracked  with  minimal  line-of- 
site  (LOS)  error.  Typically,  beam  directors  incorporate  both  passive  and  active  tracking 
to  minimize  LOS  error.  Active  tracking  is  used  once  an  object  is  in  the  field  of  view  and 
there  is  enough  return  image  intensity  for  a  coarse  or  fine  acquisition  sensor,  such  as  a  30 
Hz  frame  rate  camera  and/or  a  focal  plane  array,  to  close  a  beam  steering  mirror  loop. 
The  beam  steering  mirror  is  commonly  called  a  fast  steering  mirror  (FSM).  Passive 
tracking,  also  known  as  predictive  control,  uses  ephemeris  computation  as  a  command 
input  to  a  beam  director's  gimbal  position  servo  loop.  A  tracking  error  signal  is  then 
derived  from  an  encoder  measuring  beam  director  gimbal  position.  The  passive  LOS 
stabilization  is  thus  considered  "open-loop"  pointing  in  the  sense  that  no  precise 
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measurement  of  tracking  error  using  a  target  image  is  fed  back  to  close  the  gimbal 
position  servo  loop. 

The  two  types  of  tracking  can  be  simultaneously  used  to  effectively  reduce  LOS 
error.  The  acquisition  and  tracking  of  an  object  starts  with  open-loop  pointing,  where 
assuming  the  ephemeris  data  is  accurate  enough  to  bring  the  object  into  view  of  a  coarse 
acquisition  camera,  an  update  is  made  to  the  ephemeris  making  it  more  accurate.  Once 
the  return  image  yields  enough  intensity  on  a  fine  acquisition  sensor,  a  focal  plane  array, 
the  FSM  loop  can  be  closed  to  further  reduce  the  LOS  error  effects  of  residual  gimbal 
motion2,  atmospheric  turbulence,  and  ephemeris  inaccuracy. 

Tracking  low-earth  orbit  satellites  presents  a  very  difficult  challenge  for  a  beam 
director,  because  the  gimbal  must  reach  velocities  of  5°  to  10°  per  second,  demanding 
extremely  large  step  sizes  in  the  ephemeris  position  command  and  causing  many  plant 
disturbances  that  must  be  rejected.  Assuming  that  the  ephemeris  is  accurate,  good  open- 
loop  pointing  will  have  LOS  error  of  less  than  5  farad  RMS  [5:60],  Of  course,  the 
measure  of  "good"  tracking  will  vary  with  the  requirements  of  the  particular  task. 
Typically,  once  the  FSM  loop  is  closed  LOS  error  can  be  reduced  to  sub-ftrad. 

Although  it  is  true  that  a  FSM  loop  with  high  bandwidth  and  adequate  dynamic 
range  can  effectively  reduce  LOS  error,  it  is  necessary  to  have  accurate  open-loop 
pointing  for  several  reasons:  return  image  intensity  must  initially  be  present  on  the  coarse 
and/or  fine  acquisition  sensor;  image  intensity  must  remain  uninterrupted;  if  the  FSM 
should  break  track  and  open-loop  pointing  is  accurate,  intensity  will  not  be  lost  and  FSM 
tracking  can  be  immediately  resumed;  and  if  open-loop  pointing  is  accurate,  the  more 
likely  the  FSM  will  not  break  track.  For  large  propagating  laser  beam  divergence,  full 
angle  50  to  70  firad,  open-loop  pointing  accuracy  is  not  as  critical  as  it  is  for  smaller 
beam  divergence.  As  long  as  there  is  enough  intensity  on  the  acquisition  sensors  the 

2  Residual  gimbal  motion  refers  to  the  LOS  error  not  rejected  or  possibly  even  created  by  the  closed 
position  servo  loop,  or  open-loop  pointing. 
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FSM  bop  can  be  closed  to  reduce  LOS  error.  However,  for  example,  if  the  beam 
divergence  is  30  firad  full  angle  and  open-loop  pointing  is  5  prad  RMS  the  LOS  error  will 
have  peaks  of  15  prad  and  appropriate  intensity  can  not  be  maintained  to  close  the  FSM 
loop.  Add  an  ephemeris  bias  error  of  5  to  10  prad  and  the  problem  is  worse.  Also,  there 
are  times  when  closing  the  FSM  loop  will  not  be  possible,  such  as  tracking  dim  sunlit 
satellites  where  the  image  does  not  have  the  required  intensity,  or  daylight  tracking  of 
objects  where  the  sensitive  coarse  acquisition  camera  cannot  be  used  and  signal-to-noise 
(S/N)  ratio  of  the  fine  acquisition  sensor  is  too  low  due  to  sunlight. 

1.2  Problem  Statement 

The  SBD  linear  dynamics,  non-linearities,  plant  disturbances,  and  sensor  noise  need 
to  be  modeled,  and  design  of  a  controller  for  the  position  servo  loop  is  needed,  which  will 
effectively  reject  modeled  plant  disturbances  and  track  actual  ephemeris  data  for  a  low- 
earth  orbiting  satellite  to  less  than  5  prad  RMS. 

1.3  Objectives 

The  SBD  currently  has  a  controller  in  operation  that  meets  the  specifications 
described  in  the  background  section.  That  controller  was  developed  by  classical  control 
design.  The  object  of  this  thesis  is  two-fold;  First,  design  a  controller  that  has  better 
performance  than  the  current  controller,  and  second,  use  optimal  control  design 
techniques  to  develop  the  controller. 

1.4  Scope 

While  in  the  background  section  many  parts  of  the  ATP  system  were  described,  this 
thesis  only  addresses  the  position  servo  loop  or  open-loop  pointing.  From  here  on, 
closed-loop  tracking  will  be  in  reference  to  the  position  servo  loop  as  opposed  to  the 
closed  FSM  loop.  The  position  servo  loop  is  made  up  of  two  loops;  the  coarse  position 
loop  and  the  tine  position  loop.  The  coarse  position  loop  uses  "bang-bang"  control  to 
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provide  a  time  optimal  response  to  large  position  commands.  A  maximum  voltage  in  the 
feedforward  path  creates  a  constant  acceleration  or  deceleration.  Once  the  position  error 
falls  below  a  predefined  level,  the  control  switches  from  the  coarse  to  the  fine  position 
loop.  The  controller  design  in  this  thesis  is  only  for  the  fine  position  loop. 

The  plant  model,  for  which  the  controller  is  designed,  does  not  account  for  the 
effects  of  high  frequency  resonant  dynamics.  Notch  filters  will  have  to  be  designed  as 
they  have  been  for  the  current  controller. 

Coupling  between  the  azimuth  and  elevation  axes  is  not  considered  in  this  thesis. 
Separate  controllers  are  designed  for  each  axis,  which  simplifies  the  design  to  two  single¬ 
input  single-output  (SISO)  systems.  Simplifying  the  design  is  not  the  motivation  behind 
not  including  coupling,  but  rather  that  the  coupling  is  not  understood  well  enough  to 
model. 

1.5  Assumptions 

Saturation  occurs  when  the  compensator  output  is  greater  than  ±10  volts.  Non¬ 
linear  saturation  analysis  is  not  performed  with  the  fine  position  loop.  It  is  assumed  that 
by  the  time  hand-off  from  the  coarse  to  the  fine  position  loop  occurs  the  system  will  be 
approaching  steady  state  conditions  and  the  transients  due  to  the  hand-off  will  not  be  too 
severe.  Even  if  this  is  not  a  completely  valid  assumption,  the  results  of  the  comparison  of 
the  currently  used  controller  versus  the  H2  controller,  in  Chapter  5,  show  that  the  output 
voltage  transients  due  to  various  commanded  input  types  are  very  similar.  Therefore,  the 
H2  controller  should  not  perform  any  worse  than  the  current  controller  in  regard  to 
saturation. 

A  major  source  of  disturbance  in  the  system  is  back  electro-magnetic  field  (EMF) 
of  the  motor.  The  amplifier  has  built-in  proportional  plus  integral  (PI)  control  circuitry 
for  the  purpose  of  rejecting  the  back  EMF.  Since  measured  closed-loop  amplifier 
dynamics  are  used  in  the  plant  model,  back  EMF  is  not  simulated  as  a  disturbance.  It  is 
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assumed  that  the  built-in  amplifier  circuitry  yields  zero  steady  state  error  due  to  the  EMF. 
The  EMF  can  be  simulated  as  a  step  input  because  it  is  a  linear  function  of  velocity  and 
velocity  is  nearly  constant  throughout  a  satellite  pass.  PI  control  yields  zero  steady  state 
error  to  a  step  input.  At  worse  case  the  commanded  position  input  has  a  small 
acceleration  component,  in  which  case  the  EMF  is  a  ramp  disturbance  and  with  a  near 
integrator  in  the  H2  controller  the  result  should  be  near  zero  steady  state  error.  A  full 
description  of  the  amplifier  dynamics  is  presented  in  section  2.4.1. 

1.6  Tools 

All  computer  modeling,  analysis,  and  word  processing  was  done  on  a  Macintosh 
Ilsi  with  a  32K  cache  card,  20MHz  math  coprocessor,  5MB  of  RAM,  and  a  40MB  hard 
drive.  Microsoft  Word  5.0  was  used  for  word  processing.  Matlab/Simulink™  was  used 
for  modeling,  controller  design,  and  analysis.  Linear  modeling  and  controller  design 
utilized  the  Control  System,  Robust-Control,  Matlab,  and  Signal  Processing  Toolboxes, 
and  the  H2  and  Hoo  algorithms  written  as  Matlab  script  M-files  by  Dr.  Brett  Ridgely. 
Simulations  with  the  controller,  full  linear  plant,  non-linearities,  plant  disturbances,  and 
sensor  noise  were  performed  in  Simulink. 

1.7  Thesis  Organization 

This  thesis  concentrates  on  the  controller  design  for  the  coelostat's  azimuth  axis  for 
several  reasons.  First,  it  is  only  necessary  to  show  the  detailed  design  of  the  controller  for 
one  axis  to  demonstrate  the  optimal  control  design  techniques.  Second,  the  azimuth  axis 
is  chosen  because  more  accurate  data  is  available  for  the  azimuth  plant  dynamics  than  for 
the  elevation  axis  dynamics.  Third,  the  comparison  of  the  optimal  design  to  the  current 
azimuth  axis  controller  is  straightforward  compared  to  the  current  elevation  axis 
controller,  where  direct  feedforward  control  had  to  be  implemented  for  reasons  not  even 
the  SBD  engineers  clearly  understand. 
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Chapter  2  details  the  nominal  and  truth  plant  model,  non-linear  effects,  plant 
disturbances,  and  sensor  noise  for  the  azimuth  axis. 

Chapter  3  gives  an  overview  of  optimal  control  design  techniques. 

Chapter  4  details  the  azimuth  axis  optimal  controller  design  with  some  results  of  the 
less  successful  controllers. 

Chapter  5  starts  with  a  description  of  the  controller  currently  used  on  the  azimuth 
axis  and  then  compares  and  contrasts  the  simulation  results  of  the  best  H2  controller 
versus  the  current  controller. 

Chapter  6  builds  the  model  and  designs  the  controller  for  the  elevation  axis  and 
provides  results. 

Chapter  7  presents  conclusions  and  recommendations  for  future  research. 
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//.  Starfire  Beam  Director  Modeling 


2.1  Introduction 

The  first  few  sections  of  this  chapter  describe  the  overall  function  and  operation  of 
the  SBD.  The  emphasis  of  this  chapter  is  contained  in  the  last  sections  where  the  linear 
nominal  model,  plant  disturbances,  sensor  noise,  and  the  truth  model,  which  incorporates 
the  high  frequency  amplifier  dynamics,  discrete  control  effects,  and  non-linearities  are 
developed.  It  is  important  to  distinguish  between  the  nominal  and  truth  models  because 
the  optimal  controller  is  designed  for  the  nominal  model,  plant  disturbances,  and  sensor 
noise,  while  simulations  are  performed  with  the  truth  model. 

2.2  Starfire  Beam  Director  Description 

The  SBD  is  an  elevation  over  azimuth  coelostat  that  maintains  a  1 -meter  clear 
aperture  over  a  full  hemisphere.  The  coelostat  weighs  approximately  6  tons  and  has 
hydrostatic  oil  bearings  in  both  axes  to  reduce  bearing  friction  and  noise.  The  azimuth 
motor  can  generate  a  maximum  torque  of  3000  ft-lbs  and  the  elevation  motor  300  ft-lbs. 
The  maximum  rates  for  the  azimuth  and  elevation  axes  are  set  at  10°  and  5°  per  second, 
respectively  .  It  currently  has  the  capability  to  track  celestial  objects  and  artificial 
satellites  with  less  than  2  (irad  RMS  of  LOS  error.  Figure  2-1  is  a  picture  of  the  SBD. 
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Figure  2-1  Starfire  Beam  Director 


2.3  System  Configuration 

Figure  2-2  represents  a  beam  director  configuration  similar  to  the  SBD.  There  is  an 
optical  bench  on  which  the  visiting  experimenters  can  mount  lasers  and  optical 
equipment.  The  Coude'  path3  contains  a  large  turning  fiat  mirror,  a  mirror  mounted  to  the 
gimbal's  azimuth  axis,  and  a  mirror  mounted  to  the  elevation  axis. 

Figure  2-3  is  the  top  level  block  diagram  of  the  beam  director  system.  The 
experimenter's  interface  (El)  allows  the  experimenters  to  select  a  mode  to  point  at  a 
selected  star,  planet,  or  satellite.  The  remote  controller  (RC)  calculates  the  pointing 
vector  (ephemeris)  based  on  the  mode  selected.  The  output  of  the  RC  is  the  position 
command  input  to  the  position  servo  loop,  or  what  the  SBD  engineers  refer  to  as  the  inner 
loop.  The  local  controller  (LC)  refers  to  both  the  coarse  and  fine  position  loops. 


3 The  Coude’  path  is  the  optical  path  from  the  edge  of  the  optical  bench  to  the  exiting  side  of  the  elevation 
mirror. 
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OPTICAL  BENCH  (TOP  VIEW) 


Figure  2-2  Beam  Director  Configuration 


Figure  2-3  Top  Level  System  Block  Diagram 


From  here  on,  this  thesis  only  addresses  the  fine  position  loop  portion  of  the  local 
controller  shown  in  Figure  2-4.  The  SBD  utilizes  high  speed  digital  signal  processors 
(DSP)  running  at  200  Hz  to  execute  digital  control.  The  compensator  output  is  then 
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converted  to  an  analog  voltage  signal  to  drive  the  plant.  Gimbal  position  is  measured  by 
highly  accurate  Inductosyn™  encoders,  one  for  each  axis,  and  the  digitally  measureu 
position  is  fed  back  to  form  position  error.  Although  the  controller  is  discrete,  it  is 
designed  and  simulated  in  the  continuous  domain  using  a  continuous  approximation  to  a 
zero-order  hold  to  account  tor  the  delay  effects  of  discrete  control.  The  approximation  is 
developed  in  section  2.6. 


Figure  2-4  Fine  Position  Servo  Loop 


2.4  Azimuth  Axis  Linear  Plant  Model 

The  plant,  consisting  of  an  amplifier,  motor,  and  gimbal  is  shown  in  Figure  2-5. 
The  current  feedback  loop  is  necessary  to  reject  back  EMF  disturbance,  which  is 
discussed  in  detail  in  section  2.4.1.  The  closed  current  loop  Gr/  can  be  modeled  as 

G  (■;)-  Gm(s)Ga(s) 
d  1  +  Gm(s)Ga(s)KFB 
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Figure  2-5  Coelostat  Plant 


The  parameter  values  used  to  construct  the  plant  dynamics  are  obtained  from  two 
sources.  The  first  source  is  the  original  coelostat  documentation.  Technical  Description 
of  a  Coelostat  System  [  1  ].  The  parameters  and  the  values  used  in  the  model  are  shown  in 
Table  2-1(1 : 134].  The  second  and  most  accurate  source  is  frequency  response  data  taken 
from  the  actual  SBD  system  in  June  1991.  The  frequency  responses  are  more  accurate 
than  the  technical  documentation  because  the  documentation  was  written  over  twenty 
years  ago  and  most  of  the  parameters  have  changed  due  to  system  wear  and  small 
modifications.  Unfortunately,  complete  frequency  response  data  is  not  available  for 
every  component  of  the  plant;  therefore,  documentation  data  is  used  for  part  of  the  model. 


Table  2-1  Documentation  Parameters 


J  Parameter 

Azimuth  Axis 

Moment  of  Inertia  (ft-lbs-sec2) 

J 

26000 

Coefficient  of  Viscous  Friction  (ft-lbs/rad/sec) 

Kv 

350 

Motor  Torque  Constant  (ft-lbs/amp) 

Kt 

75.6 

Motor  Lag  Frequency 

bhtlb 

60.0 
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Ideally,  to  accurately  determine  the  frequency  response  of  each  component  of  the 
plant,  the  input  and  output  of  each  component  should  be  directly  measurable.  Figure  2-6 
depicts  the  position  servo  loop  and  the  signals  that  were  measured  to  determine  the 
system's  frequency  responses  .  The  signal  generator  and  the  signal  analyzer  are  shown  as 
separate  devices  for  clarity.  Actually,  they  are  both  part  of  a  Hewlett-Packard  Dynamic 
Signal  Analyzer.  A  sine  signal  xft)  was  input  at  the  summing  junction  and  the  component 
transfer  functions  were  calculated  by  measuring  the  signals  vft),  y(t),  aft),  and  0mf r>  as 
the  frequency  of  x(t)  was  incremented  through  a  range.  v(t)  is  the  voltage  output  of  the 
compensator,  yft)  is  the  difference  between  vft)  and  the  signal  generator  output  x(t),  aft) 
is  the  ampere  output  of  the  current  loop,  and  6m(t)  is  the  digitally  measured  gimbal 
position.  Open  and  closed-loop  transfer  function  data  was  acquired  with  this  setup, 
where  the  open  and  closed  loops  were  defined  as 


=Gc(s)Gg(s)KrGJs) 

y(s)0l 


v(s)  Gc(s)Gg(s)KrGJs) 
x(s)  cl  1  +  Gc(s)Gg{s)KTGcl  (s) 


(2.2) 


However,  only  the  current  loop  data  is  useful  for  modeling  and  is  described  by  the  open 
loop  transfer  function 


GJ*)  = 


a(s) 

y(s) 


(2.3) 


The  torque  constant  KT  and  the  gimbal  dynamics,  theoretically,  could  have  been  backed 
out  of  the  open  loop  transfer  function  of  Qm( t)  to  y(  t),  but  the  data  was  not  output  at  low 
enough  frequency  to  determine  the  low  frequency  effect  of  the  gimbal's  viscous  damping 
Therefore,  actual  data  is  used  to  model  the  current  loop  and  parameters  from  the  original 
documentation  are  used  for  the  torque  constant  and  gimbal  dynamics.  The  controller  is 
designed  with  high  gain  and  phase  margins  (stability  robustness)  to  account  for  the 
uncertainty  associated  with  using  the  parameters  in  place  of  actual  data. 
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Signal  Generator 


2.4.1  Current  Loop.  As  briefly  discussed  in  section  1.5  the  amplifier  was  designed 
with  PI  circuitry  to  reject  back  EMF  of  the  motor.  It  was  also  designed  to  include  a  lead 
to  cancel  the  20  dB  per  decade  roll  off  at  60  rad/sec  due  to  the  motor  resistance  and 
inductance  (see  Eqn  2.4).  Figure  2-7  is  a  model  of  the  current  loop  used  in  designing  the 
presently  used  controller.  The  current  loop  parameters  for  this  model  were  obtained  from 
the  original  coelostat  document. 
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The  transfer  function  equivalent  of  the  closed  current  loop  is 


Gcl(s)  = 


2.4  xl07(s  +  60.6) 

(s  +  301 1)(5  +  1988X5  +  60.6) 


amps  /  volt 


(2.4) 


The  Bode  plot  in  Figure  2-8  shows  that  the  closed  current  loop  has  a  roll  off  at 
approximately  2000  rad/sec,  or  320  Hz,  and  a  dc  (low  frequency)  gain  of  12  dB  or  4 
amps/volt .  As  stated  in  Section  1 .5  it  is  assumed  that  the  current  loop  effectively  rejects 
the  back  EMF;  therefore,  back  EMF  is  not  simulated  and  the  measured  closed  current 
loop  transfer  function  is  used  in  the  model. 
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Figure  2-8  Current  Loop  Frequency  Response 

The  measured  current  loop  data  came  in  the  form  of  an  HP  signal  analyzer  Bode 
plot  and  can  be  closely  modeled  as  a  standard  second-order  transfer  function 


Gcl(s)  = 


KgWgf, 


s2+2;acoans  +  col„ 


(2.5) 


This  plot  showed  another  dB/decade  attenuation  at  approximately  2000  rad/sec.  but  at 

such  a  high  frequency  its  contribution  to  system  dynamics  would  be  negligible;  therefore, 

it  was  neglected.  The  plot  was  reconstructed  in  Matlab  by  iteration  until  the  shape  of  the 

simplified  second  order  model  matched  the  original4.  The  reconstructed  simplified  model 

Bode  plot.  Figure  2-9,  shows  the  current  loop  having  a  natural  frequency  coa„  of 

approximately  560  rad/sec,  or  90  Hz;  a  gain  constant  Ka  =  4.4  amps/volt;  and  a  damping 

ratio  C,a  =  .25.  The  damping  ratio  was  determined  from  reference  [2:253]. 

5 The  Matlab  frequency  response  plot  has  20  dB  more  gain  than  the  original  HP  frequency  spectral  analyzer 
plot  to  account  for  a  10  amp/volt  scale  factor. 
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Figure  2-9  Second-Order  Model  of  Current  Loop  Frequency  Response 

It  is  necessary  to  transform  all  dynamics  to  a  state-space  representation  to  be  used 
in  optimal  control  design.  The  state-space  representation  of  Gci(s)  is  derived  as  follows: 


Gd{s)  = 


KgUln 


a{s) 


V’U)  J  +  2  Ca(Oar,S  +  CO, 


2 

an 


(2.6) 


where  v(t)  is  the  voltage  input  to  the  current  loop  and  a(t)  is  the  current  output.  After 
cross  multiplying  and  taking  the  inverse  Laplace  transform  of  both  sides  the 
corresponding  output  differential  equation  becomes 


a(t)  +  2£acoana(t)  +  co2a„a(t)  =  Kaco2a„v{t) 


(2.7) 


The  state  variables  are  defined  as 
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The  input  and  output  are,  respectively. 


ua(t)  =  v{t),  ya(t)  =  aft) 


(2.9) 


The  phase-variable  canonical  form  of  the  state-space  model  is 


xa(t)  =  Aaxa(t)+  Baua(t) 
ya(t)  =  Caxa(t)  +  Daua{t) 


(2.10) 


where  Aa  is  the  amplifier  system  matrix,  Ba  is  the  input  matrix,  Ca  is  the  output  matrix, 
and  Da  is  the  direct  feedthrough  term  having  the  values 


A,= 


o  1 

*2 


®an 

Q=[i  o] 


Ba  = 


0 


\_KaCDan  j 


(2.11) 


Da=  0 


2.4.2  Gimbal  Dynamics.  The  motion  of  the  gimbal  can  be  described  by  the 
differential  equation 


70(r)  +  Kxm  =  Tm  (0  (2.12) 

where  7  is  the  moment  of  inertia,  Kv  is  the  coefficient  of  viscous  friction  due  to  the 
viscosity  of  the  fluid  in  the  hydrostatic  bearings,  and  Tm(t)  is  the  torque  applied  by  the 
motor  [3:133].  7  and  Kv  are  obtained  from  the  coelostat's  original  documentation  (see 
Table  2- 1 ).  The  state  variables  are  defined  as 


(2.13) 


fowl 


xgW  = 


0(0 


The  input  and  output  are,  respectively, 

ug(t)  =  Tm(t)  yg(t)  =  Q(t). 
The  corresponding  state-space  representation  is 


0(0 

'0 

1  ' 

’0(0" 

‘O' 

0 

-Kv 

+ 

1 

.0(0. 

J  . 

.0(0. 

.J. 

6(0  =  [1  0] 


6(0' 

0(0 


Tm(0 


+  [0]Tm(t) 


(2.14) 


(2.15) 


or 


xg  (t)  =  AgXg  (t)  +  BgUg  ( t) 
yg(  t)  =  CgXg(t)+  DgUg  ( t) 


(2.16) 


2.4.3  Nominal  Plant  Model.  When  designing  a  controller  using  optimal  design 
techniques  it  is  desirable  to  design  the  controller  around  a  nominal  model  and  then 
perform  simulations  with  the  truth  model.  Optimal  control  will  yield  controllers  with  at 
least  as  many  states  as  the  plant;  therefore,  it  is  desirable  to  keep  the  order  of  the  plant 
small  to  keep  the  order  of  the  controller  small.  The  nominal  plant  model  only  includes 
the  current  loop  gain  constant  Ka ,  the  motor  torque  constant  Kj ,  and  the  gimbal  dynamics 
Gg(s)  as  shown  in  Figure  2-10.  The  high  frequency  current  loop  dynamics  are  included 
in  the  truth  model. 
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Figure  2-10  Nominal  Plant  Model 


The  state-space  representation  of  the  nominal  plant  is 


0(0 

'0  1  ' 

0(0 

'  0  ' 

= 

+ 

1 

0(0. 

0  — 

J  . 

.0(0. 

7jKjK\ 

0(0  =  [1  0] 


6(0 

0(0 


v(0 


+  [0]v(r) 


(2.17) 


or 


*p(t)  -  Apxp(t)+  Bpup(t) 
yp(  0  =  Cpxp(t)  +  Dpup(t) 


(2.18) 


2.5  Plant  Disturbances  and  Sensor  Noise 

There  are  many  sources  of  plant  disturbances  and  sensor  noise;  some  are  used  in  the 
nominal  model  to  design  the  optimal  controller,  some  are  only  included  in  the  truth  model 
for  simulation,  and  others  are  neglected.  The  position  servo  loop  is  shown  in  Figure  2- 1 1 
with  all  sources  of  plant  disturbances  and  sensor  noise. 
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Figure  2-11  SBD  Plant  Model  with  Disturbances  and  Sensor  Noise 


2.5.1  Plant  Disturbances.  Most  plant  disturbances  are  in  the  form  of  torque 
disturbances.  The  torque  disturbance  TJt)  from  Figure  2-11  is  used  to  represent  torque 
disturbance  caused  by  wind  buffeting,  motor  cogging,  and  motor  ripple.  Viscous  friction 
is  also  a  torque  disturbance  due  to  the  viscosity  of  the  fluid  in  the  hydrostatic  bearings 
and  is  already  accounted  for  in  the  nominal  plant  model.  Bearing  noise  is  a  bandlimited, 
white  noise,  torque  disturbance  that  is  neglected  because  of  the  smooth  characteristics  of 
hydrostatic  bearings.  Bearing  friction  is  a  non-linear  torque  disturbance  that  is  used  in 
the  truth  model  and  is  discussed  in  detail  in  section  2.5. 1.1.  The  last  type  of  plant 
disturbance  is  back  EMF  of  the  motor  that  reduces  power  amp  output  proportional  to  the 
speed  of  the  motor  shaft  and  is  not  a  simulated  disturbance  as  discussed  in  section  1.5. 

2.5.1. 1  Bearing  Friction.  The  Dahl  friction  model,  shown  in  Figure  2-12, 
exhibits  non-linear  bearing  stiffness  and  can  be  used  to  model  bearing  friction  in  a  gimbal 
system,  where  the  displacement  x  is  equal  to  the  change  in  0  from  an  initially  stationary 
position.  When  the  bearings  are  rolling  the  running  friction  Fc  results  in  a  constant 
torque  disturbance  Tc  opposing  the  direction  of  motion.  For  the  azimuth  axis  Tc=  16  ft- 
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lbs.  The  Dahl  friction  model  behaves  like  a  soft  spring  for  small  deflections,  yet 
approaches  the  running  friction  for  large  deflections.  When  force  is  applied  to  the 
bearings  they  experience  plastic  deformation,  known  as  the  compliance  zone.  Outside  the 
bearing  compliance  zone,  i.e.  bearings  are  rolling,  the  disturbance  is  equal  to  the  running 
friction  [6:2-4], 


i 


Figure  2-12  Dahl  Friction  Model 

The  characteristics  of  the  Dahl  friction  model  can  be  modeled  such  that  the  friction 
is  not  a  function  of  0  but  rather  a  function  of  0 .  The  bearing  friction  is  modeled  using  the 
saturation  block  and  a  constant  gain  in  Simulink.  Figure  2-13  is  the  Simulink  bearing 
friction  model.  For  0(f)  >  0.001  rad/sec  the  saturation  block's  output  value  is  constant  at 
0.001,  thus  the  torque  disturbance  is  equal  to  a  constant  16  ft-lbs,  i.e.  the  running  friction 
torque  constant.  For  0(f)  <0.001  rad/sec  the  torque  disturbance  is  a  linear  function  of 
0(f), 
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Torque  =  f  16000  lt?S  W) 
v  rad  /  sec  J 


(2.19) 


which  captures  the  characteristic  of  the  Dahl  compliance  zone,  where  small  motions  from 
an  initially  stationary  position  result  in  plastic  deformation  and  bearing  friction 
resistance. 


Torque 
Disturbance , 


Figure  2-13  Simulink  Bearing  Friction  Model 

2.S.1.2  Wind  Buffeting.  Wind  buffeting  disturbance  data  is  not  available 
from  the  SBD,  so  data  from  another  beam  director  is  used  as  an  estimate  [5:54],  The  data 
is  in  the  form  of  a  power  spectral  density  (PSD)  plot  with  units  (ft-lbs)2/Hz/Hz.  The 
wind  disturbance  PSD  I Jco)  is  characterized  as  low  frequency  colored  noise  and  can  be 
modeled  as  a  coloring  filter  Wd< jco)  driven  by  zero  mean,  unity  intensity,  white  Gaussian 
noise  X„(£t>),  where 


Id(co)  =  \Wd{jcof  ln{co)  (2.20) 

The  resulting  coloring  filter  Wd(s)  is  shown  in  Figure  2-14. 
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Frequency  (rad/sec) 

Figure  2-14  Wind  Buffeting  Coloring  Filter 


2.5. 1.3  Motor  Ripple  and  Cogging.  Ripple  torque  disturbance  is  due  to  a 
small  variation  in  average  torque  during  rotation  of  the  armature.  This  variation  is  due  to 
the  fact  that  commutation  is  done  in  discrete  steps.  The  ripple  torque  is  a  deterministic 
low  frequency  sinusoidal  effect  that  is  a  function  of  the  motor  shaft  velocity  [7:13]. 

Cogging  torque  disturbance  is  due  to  the  non-uniform  rotation  of  the  motor 
armature  caused  by  the  tendency  of  the  armature  to  prefer  certain  discrete  positions. 
Cogging  torque  is  also  a  deterministic  low  frequency  effect  that  is  a  function  of  the  motor 
shaft  velocity  [7:13]. 

Since  both  disturbances  are  low  frequency  they  can  be  effectively  rejected  if  the 
position  servo  loop  has  adequate  bandwidth  and  low  frequency  gain.  The  two 
disturbances  can  be  conservatively  modeled  as  a  coloring  Filter  driven  by  white  noise. 

The  only  data  available  on  the  actual  effects  of  ripple  and  cogging  disturbance  is  that  it  is 
a  low  frequency  effect  that  contributes,  when  not  rejected,  approximately  60  |irad  of 
gimbal  position  error.  The  coloring  filter  designed  for  the  wind  buffeting  disturbance 
creates  30  firad  of  error  when  the  position  servo  is  simulated  open  loop.  The  final  torque 
disturbance  coloring  filter  used  for  the  controller  design  and  simulation  is  designed  to 
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incorporate  wind  buffeting,  cogging,  and  ripple  disturbance  effects  and  is  shown  in 
Figure  2-15. 


Figure  2-15  Torque  Disturbance  Coloring  Filter 


As  stated  earlier,  this  disturbance  input  is  used  in  the  optimal  controller  design, 
therefore,  the  coloring  filter  must  be  transformed  to  its  state-space  representation. 

In  transfer  function  form 


Wd(s)  —  Cd(sl  —  Ad)  lBd  +  Dd 


(2.21) 


In  state-variable  form 


xd{t)  =  Adxd(t)+  Bdwx(t) 
Td(r)  =  Cdxd{t)  +  Ddwx(t) 


(2.22) 


where  Td(t)  is  the  torque  disturbance,  xd(t)  is  the  disturbance  state,  and  wi(t)  is  zero-mean, 
unit  intensity,  white  Gaussian  noise.  The  state-space  values  are 


A*  =  -l  Bd  =  1 
Q  =  1000  Dd=  0 


(2.23) 
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2.5.2  Sensor  Noise.  The  absolute  angular  gimbal  position  is  measured  using  an 
Inductosyn  encoder.  The  measurement  of  true  angular  position  is  corrupted  by  noise  with 
an  RMS  of  .2  arc  seconds  or  1  (irad  and  is  modeled  as  zero-mean,  white  Gaussian  noise 
for  the  controller  design.  For  the  simulation  the  sensor  noise  is  rolled  off  at  40  dB  per 
decade  starting  at  50  rad/sec  to  prevent  the  unrealistic  driving  of  high  frequency  control 
power.  A  second  source  of  encoder  errors  are  cyclic,  deterministic  errors,  which  are  a 
function  of  the  rotation  angle,  generally  comprised  of  modulated  harmonics  of  the  basic 
Inductosyn  pole  frequency  [7:4].  Modeling  of  the  cyclic  errors  is  beyond  the  scope  of 
this  thesis. 

2.6  Digital  Control  Effects 

Digital  control  has  several  dynamic  effects  which  can  be  adverse.  Those  effects  are 
quantization,  CPU  computational  time,  and  sample  rate. 

As  shown  in-Figure  2-6  the  input  to  the  inductosyn  encoder  is  continuous  time 
gimbal  position  and  the  output  is  digital.  Quantization  of  the  gimbal  position 
measurement  is  occurring  due  to  the  finite  word  length  of  the  encoder.  Without  getting 
into  the  details  of  the  encoder,  the  least  significant  bit  is  0.75  (trad.  Quantization  effects 
will  be  neglected,  because  the  noise  effects  of  the  encoder  are  modeled  such  that  the  noise 
spectrum  will  account  for  quantization  uncertainty. 

The  controller  hardware  consists  of  a  Texas  Instrument  320  C-30  Digital  Signal 
Processor  (DSP)  programmed  in  C,  housed  in  a  VME  chassis,  with  a  Macintosh  PC  as  the 
host.  The  system  runs  at  200  Hz,  which  corresponds  to  a  sample  time  T  of  0.005  seconds. 
The  DSP  computational  time  delay  tD  is  assumed  to  be  =  0,  which  is  a  valid  assumption  if 
zD  is  much  less  than  r[4:7]. 

The  dynamic  effects  of  sampling  and  holding  can  be  neglected  when 

cos  >  30 coc  (2.24) 
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where  0)s  is  the  sample  frequency  and  coc  is  the  system  cross-over  or  bandwidth 
frequency.  Since  Q)c  is  approximately  10  Hz  and  cos  is  200  Hz,  the  ratio  is  20,  thus  the 
dynamics  cannot  be  neglected.  Figure  2- 16(a)  shows  the  continuous  model  of  the 
sampler  and  the  zero-order  hold  (ZOH). 


(a) 


Gsd(s) 


(b) 


Figure  2-16 

(a)  Continuous  Model  (b)  Continuous  Approximation 


The  sampler  can  be  approximated  by  1  IT  and  a  first-order  Pade’  approximation 
Gpa(s)  can  be  used  to  linearize  and  approximate  the  ZOH.  Thus, 

C»(j)«^---2t  =  C„(j).  (2.25) 

s  s  +  — 

T 

The  first  order  Pade'  approximation  is  valid  for  this  system  because  cos  >10<yf  [4:213]. 
The  combination  of  the  sampler  and  ZOH  approximations  are  defined  as  GSd(s)  which 
represent  the  reduced,  approximated,  and  linearized  effects  of  digital  control  (see  Figure 
2- 16(b)). 

2.7  SBD  Model  Summary 

The  optimal  controller  is  designed  around  the  nominal  model,  which  includes: 
current  loop  gain  constant  Ka\  motor  torque  constant  Kj\  gimbal  dynamics  Gg(s) ;  torque 
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disturbance  input  Td(t)\  and  zero-mean,  white  Gaussian  noise,  of  1  firad  intensity  sensor 
noise.  The  truth  or  simulation  model  includes  the  nominal  model  plus:  dynamics  of  the 
current  loop  Gci(s)\  non-linear  bearing  friction;  first  order  Pade'  approximation  to  a  ZOH; 
and  sensor  noise  rolled  off  at  40  dB  per  decade.  The  azimuth  axis  parameter  values  are 
summarized  in  Table  2-2. 


Table  2-2  Azimuth  Axis  Parameters 


j  Parameter 

Value 

Moment  of  Inertia  (ft-lbs-sec2) 

J 

26000 

Coefficient  of  Viscous  Friction  (ft-lbs/rad/sec) 

Kv 

350 

Motor  Torque  Constant  (ft-lbs/amp) 

KT 

75.6 

Sample  Period  (sec) 

T 

0.005 

Current  Loop  Gain  Constant  (amp/volt) 

- L - i— - 

Ka 

4.4 

Current  Loop  Damping  Ratio 

Ca 

.25 

Current  Loop  Natural  Frequency  (rad/sec) 

Wan 

560 

Bearing  Friction  Torque  Constant  (ft-lbs) 

Tc 

16 
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III.  Optimal  Control  Design  Techniques 


3.1  Background 

H2  or  Hoo  control  design  begins  with  the  standard  positive  feedback  setup  shown  in 
Figure  3- 1 . 


W 


u 


Figure  3-1  Optimal  Control  Setup 


P  is  the  plant,  K  is  the  compensator,  w  is  the  exogenous  input,  z  is  the  controlled  output,  u 
is  the  control  input,  and  y  is  the  measured  output.  P  includes  system  plant  dynamics, 
exogenous  input  coloring  Filters,  and  any  dynamic  weights  on  the  controlled  outputs.  P  is 
partitioned  as 


such  that 


(3.1) 


(3.2) 
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The  closed-loop  transfer  function  T ^  ,  which  is  the  transfer  function  from  the  external 
input  w  to  the  controlled  output  z,  is  given  by 


T„=P„  +  P,K(l-P„K)~'py,  (3.3) 

The  objective  is  to  design  a  stabilizing  controller  K  such  that  the  2-norm  or  °°-norm  of  the 
closed-loop  transfer  function  T ^  is  minimized.  Controller  design  by  Hoo  optimization 
for  the  SBD  model  was  less  than  completely  successful  (see  section  4.2).  Therefore,  the 
Hoo  optimization  theory  and  method  is  not  presented. 

The  2-norm  is  defined  for  a  stable  transfer  function  as 


1  °° 

—  J  dco 


(3.4) 


where  tr  is  the  trace  and  *  denotes  the  complex  conjugate  transpose.  Thus,  the  2-norm  of 
the  transfer  function  Tw  is  minimizing  the  expected  value  of  the  energy  of  the  output  z 
assuming  the  input  w  is  zero-mean,  unit  intensity,  white  Gaussian  noise. 

The  plant  P  is  described  by  the  state-variable  differential  equations 

x  =  Ax  +  Bww  +  Buu 

z  =  Czx  +  D^w  +  Dzuu  (3.5) 

y  =  Cyx  +  Dyww  +  Dyuu 

or 


'a 

K 

K 

p  = 

c. 

K 

c 

D 

D 

L  y 

VH 

yu 
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(3.6) 


The  following  conditions  on  P  must  be  true: 


i)  0^=0 


ii) 

iii) 

iv) 


v) 


vi) 


DyU  =  0 

(A,  Bu )  stabilizable  &  ( Cy ,  A)  detectable 
DIuDzu  &  DywDlw  rank 


*3 

1 

1 _ 

_ 1 

cT 

_ J 

DZu\ 

fA  -  jct)I 

Bw' 

1 - 

vP 

V 

has  full  column  rank  for  all  to 


has  full  row  rank  for  all  03 


Condition  i)  is  required  or  the  H2  problem  is  not  well  defined,  as  the  closed-loop 
transfer  function  will  then  have  a  nonzero  D  term  for  any  choice  of  compensator,  thus 
making  the  closed-loop  two-norm  infinite.  Condition  ii)  makes  the  development  easier, 
but  can  be  completely  removed.  Condition  iii)  is  necessary  for  the  existence  of 
stabilizing  solutions.  Condition  iv)  ensures  that  the  penalty  on  control  usage  and  the 
sensor  noise  intensity  are  nonsingular  -  relaxation  leads  to  singular  control  problems. 
Conditions  v)  and  vi)  guarantee  the  existence  of  stabilizing  solutions  to  the  two  Riccati 
equations  which  appear  in  the  solution  to  the  problem.  [8:69-70] 

The  H2  optimal  controller  is  given  by 


K(s)  =  -KC[A  ~KfCy  -  BuKc)kf 


(3.7) 


where 


Ke  =  %  X  +  bI„C, 


kc  =  s~'kc 


(3.8) 

(3.9) 
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(3.10) 


Kf  =  YCy  +  BWD 


Kf  =  KfSy 

X  and  Y  are  the  solutions  to  the  algebraic  Riccati  equations 


(a  -  BuDlc,f  x+ x(a  -  4A.Q)  -  xwl  x+cTc;  =  o 

and 

(A  -  BwD^Cy)Y  +  Y(A  -  BwD^.Cy)T  -  YCTyCyX  +  bJI  =  0 

where 

c  =  (/-d.„6[„)c, 

Su  and  Sy  are  internal  scalings  such  that 


Bu  —  BUSU 


-l 


d  =  n  s'1 

L'zu  *-'zu°u 


Cy  =  SyCy 


DyW  ~  SyDyw 


(3.11) 


(3.12) 


(3.13) 


(3.14) 

(3.15) 


(3.16) 


For  H2  optimization  the  compensator  K  will  be  of  the  same  order  as  the  plant  P. 
For  a  more  thorough  description  of  H2  and  Hoo  optimization  see  reference  [8]. 


3.2  Design  Techniques 

The  First  step  in  the  optimal  control  design  sequence  is  building  the  P  matrix, 
followed  by  calculating  the  stabilizing  and  minimizing  compensator  K  using  H2  or  Hoo 
optimization,  then  simulating  the  compensator  with  the  truth  model  to  determine  if  the 
desired  performance  is  achieved.  Overall,  this  is  an  iterative  process  in  which  the  control 
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weightings  in  P  are  used  like  "dials"  to  "tune"  system  performance.  It  is  important  that 
the  nominal  plant  model  is  used  in  building  P  to  keep  the  order  of  the  compensator  to  a 
minimum. 

A  key  tool  for  building  the  P  matrix  is  the  use  of  a  state-space  biock  diagram  shown 
in  Figure  3-2  representing  the  transfer  function 

G(s)  =  C(sI-AT'B  +  D.  (3.17) 


G(s) 


Figure  3-2  State-Space  Block  Diagram  Form 

Once  an  optimal  control  problem  is  set  up  with  the  system  plant,  coloring  filters,  and 
control  weightings  represented  in  state-space  block  diagram  form,  it  is  easy  to  augment 
all  the  states  into  one  state-space  representation  of  the  entire  system.  That  sta  space 
representation  is  Eqns.  3.5,  which  as  discussed  earlier,  define  the  P  matrix. 

A  designer  has  many  configurations  to  choose  from  when  setting  up  the  optimal 
control  problem.  There  are  two  basic  optimal  control  design  setups  which  are  presented 
in  this  section.  Starting  with  a  basic  setup,  control  weightings  are  added  depending  on 
the  performance  requirements  of  the  system,  such  as  weightings  on  control  usage,  states, 
sensitivity,  complementary  sensitivity,  and  tracking.  The  two  configurations  presented 
represent  configurations  of  two  of  the  final  controller  designs  for  the  SBD. 

3.2.1  Unity  Feedback  Setup.  The  unity  feedback  setup  shown  in  Figure  3-3  has  a 
constant  weighting  R:  on  control  usage  u(t).  a  constant  weighting  H  on  the  states  xp( t). 
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and  a  dynamic  weighting  W*  on  sensitivity.  The  blocks  Ap,  Bp.  and  Cp  are  the  state-space 
representation  of  the  nominal  plant  Gp(s).  The  controller  K  is  replaced  with  Gc  and  is  not 
represented  in  state-space  form  because  it  is  not  part  of  the  P  matrix.  W^is  the  plant 
disturbance  coloring  filter  and  V  is  a  constant  matrix  used  to  distribute  the  disturbance  to 
the  proper  state.  The  inputs  w i  and  vt’2  are  zero-mean,  white  Gaussian  noise  of  unit 
intensity,  where  h  i  is  the  disturbance  input  and  vt'2  represents  sensor  noise.  The  reference 
command  djt)  is  not  actually  part  of  the  setup  for  building  the  P  matrix,  but  is  shown  to 
make  the  system  complete.  This  means  that  command  following  is  not  directly  optimized 
in  the  unity  feedback  setup.  Robust  state  regulation  is  the  real  objective  of  this  setup.  In 
fact,  if  the  dynamic  sensitivity  weighting  Ws  is  not  included,  H2  optimization  on  this 
setup  is  the  same  as  the  standard  linear  quadratic  Gaussian  (LQG)  problem  of  minimizing 
the  cost  function 


J  =  j  [xT  Qx  +  uT  Ru^dt 


0 


(3.18) 


where 


Q  =  HtH  and  R  =  R.TR. 


(3.19) 
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Figure  3-3  Unity  Feedback  Setup 


Although  good  command  input  tracking  is  not  a  direct  specification  in  this  setup,  it 
is  indirectly  achieved  by  use  of  the  dynamic  sensitivity  weighting  Ws.  The  term 
sensitivity  refers  to  the  output's  sensitivity  to  plant  uncertainties  and/or  disturbances  and 
is  defined  in  the  SISO  case  as 


S  = 


1 

1  -GpGc 


(3.20) 


It  is  desirable  in  the  case  of  the  SBD  for  the  system  to  be  insensitive  to  low  frequency 
plant  disturbances,  thus  S  would  have  a  general  shape  like  that  shown  in  Figure  3-4. 
"General"  is  stressed  because  this  discussion  assumes  that  the  plant  disturbance  is  coming 
in  at  the  plant  output,  where,  in  the  case  of  the  SBD  the  disturbance  is  actually  a  torque 
disturbance  into  the  gimbal.  The  difference  is  elaborated  when  discussing  the  actual  SBD 
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design  in  Chapter  4.  S  being  "small"  at  low  frequency  is  achieved  by  making  Gc  "large" 
or  having  high  gain  at  low  frequency.  High  gain  at  low  frequency  also  yields  good 
tracking  as  seen  in  the  closed-loop  tracking  error  response  to  the  reference  command  and 
plant  disturbance. 


err  =  -- 


1 


■6  + 


Wd 


1  -  GpGc  c  1  -  GpGc 


-w, 


(3.21) 


Frequency  (rad/sec) 


Figure  3-4  General  Shape  of  Sensitivity 

3. 2.1.1  Control  Weighting  Rationale.  Choosing  control  weighting  values  is 
not  an  exact  science;  rather  it  is  an  iterative  process.  However,  it  is  important  to 
understand  the  effects  of  the  different  weightings  to  provide  a  starting  point. 

The  control  usage  weighting  Rz  must  always  be  included  and  have  a  D  term  in  the 
optimal  control  setup  or  condition  iv)  will  be  violated  and  the  problem  will  be  singular. 
Theoretically,  if  Rz  =  0  there  is  no  penalty  on  control  usage  allowing  an  infinite  amount 
of  control  power  to  achieve  the  system  requirements.  R:  can  be  a  dynamic  weighting  if, 
for  example,  it  is  desired  to  restrict  high  frequency  control  usage.  The  next  chapter  will 
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address  that  requirement.  The  effects  of  R:  can  be  seen  by  looking  at  the  closed-loop 
transfer  function  of  zj  to  w, 


z2  = 


R,GcWd  R,Gc 

- -  VVi  -i - * - ws 

1  -GpGc  1  1  -GpGc  2 


(3.22) 


As  Rz  is  increased,  the  minimization  of  T^,  will  yield  a  decreasing  Gc,  or  in  other 
words,  less  control  usage. 

The  state  weighting  H  can  be  used  to  minimize  some  states  more  than  others.  For 
example,  in  the  case  of  the  SBD  system,  if  it  were  necessary  to  limit  the  velocity  of  the 
gimbal  a  large  weighting  would  be  put  on  the  state  0(f). 

The  sensitivity  weighting  Ws  is  chosen  to  achieve  the  desired  S  by  picking  it  to 
generally  look  like  1/S;  therefore,  Ws  would  have  high  gain  at  low  frequency.  Ws  must 
roll  off  such  that  it  does  not  contain  a  D  term  and  violate  condition  i).  The  magnitude  and 
bandwidth  would  depend  on  the  severity  of  the  disturbance  input  Wd  and  the  command 
following  requirements,  i.e.,  step,  ramp,  speed  of  response,  ect.  The  effects  of  sensitivity 
weighting  can  be  seen  by  looking  at  the  closed-loop  transfer  function  of  zi  to  w, 


Wswd  ws 

Hi  H - Wo 

1  -  GpGc  1  1  -  GpGc  2 


(3.23) 


As  the  low  frequency  magnitude  of  W5  is  increased  and/or  the  bandwidth  is  increased 
minimization  of  7%*.  will  yield  an  increasing  Gc  approximately  over  the  same  bandwidth. 
Note  that  if  Ws  is  given  a  relatively  small  low  frequency  gain,  minimization  would  still 
yield  Gc  with  high  gain  at  low  frequency  because  the  disturbance  coloring  filter  Wd  has 
high  gain  at  low  frequency.  However,  the  controller  would  typically  fall  short  of  the 
desired  performance,  thus  the  "dial"  Wj  is  needed  to  "tune"  the  performance. 
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3.2. 1.2  Building  the  P  Matrix.  The  augmented  state-space  representation  of 


the  optimal  control  setup  in  Figure  3-3  is  described  by  Eqns.  3.5.  P  is  then  formed  by 
Eqn  3.6  where. 


c,=[c,  0  o]  D„,=[0  1]  Dyu  =  [0] 


(3.24) 


3. 2. 1.3  H2  and  Hoo  Algorithms.  Once  the  P  matrix  has  been  built  there  are 
several  H2  and  Hoo  algorithms  that  take  the  P  matrix  as  an  input  and  then  output  the 
stabilizing  and  minimizing  controller  in  state-space  form.  All  the  algorithms  listed  are 
Matlab  script  M-files:  h21qg  and  hinf  are  found  in  the  Robust-Control  Toolbox;  hinfsyn 
and  hinffi  are  Hoo  routines  found  in  the  relatively  new  fi-Tools  that  calculate  output 
feedback  sub-optimal  controllers  and  full  state  feedback  sub-optimal  controllers, 
respectfully;  h2opt  and  hinf5  are  user  friendly  algorithms  used  in  this  thesis  and  were 
written  by  Dr.  Brett  Ridgely. 

3.2.2  Two-Degree  of  Freedom  Controller  Setup.  The  two  degree  of  freedom 
controller  setup  shown  in  Figure  3-5  is  a  method  which  allows  for  the  direct  design  of 
command  following  or  tracking  performance.  This  setup  fits  into  the  standard  optimal 
control  setup  of  Figure  3-1,  where  u  =  Ky,  with  K  partitioned  as 
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K  =  [Gc,  Gc2] 


(3.25) 


and 


v  = 


(3.26) 


The  control  weightings  Rz  and  H  are  used  in  the  same  manner  as  with  the  unity 
feedback  setup.  W,  is  a  dynamic  track  weighting  that  is  used  to  directly  minimize 
tracking  error.  The  effect  of  W,  can  be  seen  in  the  transfer  function  of  zj,  to  w. 


WW,  W,Gc .  (  WGc , 

l-Gc,Gp  1-GqGp  '  {l-Gc\Gp 


(3.27) 


Tracking  performance  is  normally  measured  in  terms  of  the  ability  of  a  system  to  track 
step  or  ramp  inputs;  therefore,  emphasis  of  W,  should  be  high  gain  at  low  frequency.  An 
example  of  what  W,  would  generally  look  like  is  shown  in  Figure  3-6.  An  indirect  result 
of  this  setup,  with  the  disturbance  coloring  filter  Wj  having  high  gain  at  low  frequency,  is 
good  sensitivity  or  disturbance  rejection  in  the  feedback  loop.  It  can  be  seen  from  Eqn. 
3.27  that  minimization  of  T ^  will  tend  to  make  Gc\  large  at  low  frequency. 
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Magnitude  (dB) 


Figure  3-5  Two  Degree  of  Freedom  Controller  Setup 


Frequency  (rad/sec) 
Figure  3-6  Track  Weighting 
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IV.  SBD  Azimuth  Axis  Controller  Design 


4.1  Introduction 

This  chapter  is  devoted  to  a  detailed  description  of  the  two  basic  design  setups  for 
the  azimuth  axis.  The  simulation  results  of  the  H2  optimal  two  degree  of  freedom 
controller  are  also  presented  in  this  chapter,  while  the  results  of  the  H2  optimal  unity 
feedback  controller  are  presented  in  Chapter  5.  The  Matlab  M-files  used  for  building  the 
P  matrix,  for  synthesizing  the  H2  optimal  controller,  and  for  performance  analysis  are 
included  in  Appendix  B.  A  tutorial  of  the  H2  optimization  M-file  h2opt  and  M-files 
specifically  written  for  the  SBD  controller  design  is  given  in  Appendix  D. 

4.2  Scaling  Problem 

Both  the  H2  and  Hoo  algorithms  had  numerical  problems  with  the  large  controller 
gain  required  to  achieve  prad  tracking  performance.  The  H2  problem  was  solved  by 
scaling  the  plant  Gp(s )  to  microradian  output.  Therefore,  the  resulting  controller  Gc(s) 
had  1()6  less  gain  than  it  would  have  had  with  an  unsealed  plant.  H2  optimization  was 
performed  with  the  scaled  plant  and  simply  increasing  the  resulting  controller  by  106 
rescaled  the  system.  The  scaling  equations  were 

GM^)scaled  =Gp(s)x\06  &  Gc(i)  =  Gc(s)sca]ed  X  106  (4.1) 

where  Gc(.v)Scale<l  was  the  controller  yielded  by  the  algorithm. 

The  Hoo  problem  was  not  as  straightforward,  and  all  internal  system  scaling 
attempts  yielded  less  than  completely  successful  results.  In-depth  investigation  of  the 
scaling  problem  Ho©  had  with  the  model  was  beyond  the  scope  of  this  thesis;  therefore, 
the  Hoo  solution  was  not  pursued  any  further. 
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4.3  Position  Command  Inputs 

Although  in-depth  performance  analysis  is  presented  in  Chapter  5,  some  analysis  is 
done  in  this  chapter.  Therefore,  it  is  appropriate  at  this  time  to  describe  the  position 
command  inputs  used  to  determine  performance. 

Step  response  performance  was  baselined  against  a  100  (irad  step  input;  however, 
tracking  commands  for  a  beam  director,  whether  tracking  a  star  or  a  fast  moving  low- 
earth  satellite,  are  more  accurately  described  by  a  ramp  input.  For  the  SBD  simulation 
the  step  sizes  chosen  for  the  ramp  were  500  jirad.  With  a  servo  loop  sample  rate  of  200 
Hz  this  was  equivalent  to  0.1  rad/sec  or  approximately  6°  per  second,  which  approaches 
the  maximum  azimuth  axis  velocity  of  10°  per  second. 

A  true  test  of  performance  is  to  simulate  a  system  with  a  command  input  that 
represents  real  ephemeris  data  of  a  low-earth  orbit  satellite  near  culmination,  for  this  is 
when  the  azimuth  axis  is  at  maximum  velocity.  A  five  second  sample  of  position  and 
velocity  data  extracted  from  ephemeris  data  generated  at  the  SBD  is  shown  in  Figures  4-1 
and  4-2,  respectively.  Like  the  ramp  command,  the  gimbal  velocity  due  to  the  ephemeris 
command  had  an  average  value  of  approximately  6°  per  second.  However,  as  seen  in 
Figure  4-2  there  was  an  acceleration  component  in  the  ephemeris  data,  which  made  the 
tracking  problem  more  difficult.  The  position  data  was  edited  such  that  the  initial 
position  was  0.0  and  that  it  represented  an  ascending  portion  of  a  satellite  pass.  The 
original  data  was  from  a  descending  portion  of  a  pass.  This  five  second  sample  of  data 
was  used  for  all  ephemeris  command  tracking  simulations. 
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Figure  4-1  Position  Command  Input 
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Figure  4-2  Velocity  Derived  From  Position  Command 


4.4  Unity  Feedback  Design 

Figure  4-3  shows  the  design  setup,  where  the  sensitivity  weighting  W*  was  used  for 
plant  disturbance  rejection  and  indirectly  for  good  tracking  performance.  As  stated  in 
Section  3.2.1,  sensitivity  is  defined  for  a  disturbance  added  to  the  plant's  output.  The 
disturbance  w\  actually  entered  as  a  torque  disturbance  to  the  gimbal.  However,  setting 
up  the  optimal  control  problem  with  the  disturbance  modeled  as  torque  yielded 
controllers  of  marginal  performance  for  all  weightings  Ws  that  were  tried.  Therefore,  the 
optimal  control  P  matrix  was  built  with  vvj  entering  as  a  position  disturbance  at  the  plant's 
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output  and  the  simulation  had  the  disturbance  entering  as  torque.  The  same  disturbance 
coloring  filter  Wj  was  used  for  both  the  controller  design  and  the  simulation  (see  Figure 
2-15).  It  would  seem  that  the  disturbance  entering  as  torque  would  not  be  the  same  as  the 
disturbance  entering  as  position  in  (irad,  because  the  torque  disturbance  goes  through  the 
gimbal  dynamics,  which  is  practically  a  double  integrator.  However,  in  this  case,  the 
random  white  noise  generated  by  Matlab  contained  the  appropriate  low  frequency 
spectrum  such  that  the  open  loop  feed-through  of  the  torque  disturbance  was  almost  the 
same  as  the  disturbance  spectrum  in  |irad. 


Figure  4-3  Unity  Feedback  Setup 

4.4.1  Control  Weightings.  The  control  weightings  used  in  the  setup  were  the 
control  usage  weighting  Rz ,  the  state  weighting  H,  and  the  sensitivity  weighting  Ws. 
Larger  values  of  Rz  yielded  controllers  of  lower  gain  and  vice  versa.  The  final  value 
chosen  was  R:  =  1 .  The  nominal  plant,  where  the  only  dynamics  included  were  that  of 
the  gimbal.  had  two  states,  Q(t)  and  9(r).  It  was  not  necessary  to  weight  the  stales  for  the 
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purpose  of  minimizing  the  amplitude  of  a  particular  state,  which  is  normally  the  main 
objective  of  the  state  weighting  H.  However,  including  some  weighting  proved  to  yield  a 
system  with  slightly  better  gain  and  phase  margins  than  when  a  weighting  was  not 
included.  The  final  value  chosen  was  a  weighting  of  1  on  both  states  such  that 


H  = 


1 

0 


O' 

1 


(4.2) 


The  fact  that  including  a  weighting  on  the  states  resulted  in  better  stability 
robustness  warrants  further  explanation.  Consider  the  perturbed  plant 
Gp(s)  =  (1  +  A)Gp(s)  modeled  as  output  multiplicative  uncertainty,  where  Gp(s)  is  the 

nominal  plant  and  A  is  the  uncertainty.  The  closed-loop  block  diagram  corresponding  to 
the  controller  and  this  representation  of  the  plant  is  shown  in  Figure  4-4.  Now  consider 
the  case  where  A  =  1 ;  the  closed-loop  transfer  function  of  7^.  is  equal  to  complimentary 
sensitivity  T,  where 


T  Cp(d-Ar)-'BpGc 
1  -  GpGc 

Gp(s)  in  the  numerator  is  represented  in  its  state-space  transfer  function  form  for 
demonstration.  Minimization  of  complimentary  sensitivity  provides  increased  stability 
robustness;  therefore,  minimization  of  the  transfer  function  T-*  yields  better  gain  and 
phase  margins  [9:53-54 j. 
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Figure  4-4  Output  Multiplicative  Uncertainty  Block  Diagram 


Now  consider  the  block  diagram  in  Figure  4-5,  which  represents  part  of  the  closed- 
loop  unity  feedback  setup  for  the  SBD  system,  zi  is  the  state  control  output  and  w>2  is  the 
sensor  noise  input.  Indirectly,  the  state  weighting  H  provides  for  output  multiplicative 
uncertainty  such  that  the  transfer  function  of  TZ]W2  is  similar  to  the  complimentary 

sensitivity,  thus  resulting  in  better  stability  robustness.  It  is  clear  that  the  complimentary 
sensitivity  T  in  Eqn.  4.3  is  similar  to  TZ]Wv  where 

H(sI-Apy'BpGc 
z'Wl-  1  -GpGc 

and 

'1  0 

Cp=[l  0]  //  = 

P  0  1 


(4.4) 


(4.5) 
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The  key  to  designing  a  good  controller  was  in  the  sensitivity  weighting.  After  many 
iterations  of  "dialing"  Ws>  the  final  had  a  low  frequency  gain  of  2x1  (H  and  a  pole  at  s  = 
-1(H  rad/sec  (see  Figure  4-6).  The  high  gain  of  Ws  was  necessary  to  achieve  the  system 
bandwidth  and  high  gain  at  low  frequency  needed  to  reject  the  plant  disturbance.  The 
low  frequency  pole  gave  the  controller  a  near  integrator  necessary  for  command  input 
tracking  and  rejection  of  the  non-linear  bearing  friction  disturbance,  which  is  discussed 
further  in  Chapter  5.  The  state-space  representation  of  Ws  is 


xs(t)  =  Asxs(t)+  Bs6m{t) 
Z3  =  Csxs(t)  +  Ds0m(t) 


(4.6) 


Where  z 3  is  the  controlled  output,  xs(t)  is  the  sensitivity  weighting  state,  and  0m(t)  is  the 
measured  gimbal  position.  The  state-space  values  are. 


As  =  -0.0001  Bs  =  1 
Cs=  2  Ds=  0 


(4.7) 


Frequency  (rad/sec) 


Figure  4-6  Sensitivity  Weighting 
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4.4.2  H2  Controller  Synthesis.  With  the  nominal  plant,  exogenous  inputs,  and 
control  weightings  defined  in  state-space  form,  the  P  matrix,  described  by  Eqns.  3.24  was 
built.  The  Matlab  M-file  h2opt  was  used  to  synthesize  the  H2  optimization  controller. 

As  stated  earlier,  optimal  control  produces  controllers  of  the  same  order  as  the  plant  P; 
thus,  with  a  2nd  order  nominal  plant,  one  pole  in  Wd ,  and  one  pole  in  Ws  the  resulting 
controller  was  4th  order. 

4.4.3  Controller  Fine  Tuning.  The  controller  produced  by  the  weightings 
presented  in  Section  4.4. 1  exceeded  the  tracking  and  disturbance  rejection  requirements. 
However,  the  controller  contained  relatively  high  gain  at  high  frequency;  in  other  words, 
it  did  not  roll  off  rapidly  after  the  bandwidth  of  the  system.  The  scope  of  this  thesis  did 
not  include  the  consideration  of  the  gimbal's  resonant  frequencies,  and  as  stated  earlier 
notch  filtering  would  have  to  be  implemented.  However,  knowing  that  the  resonant 
frequencies  exist,  it  was  important  to  roll  off  the  controller  as  rapidly  as  possible  without 
effecting  the  bandwidth  or  decreasing  the  gain  and  phase  margins  to  unacceptable  levels. 
There  were  two  ways  to  correct  this  problem:  one  was  to  put  a  dynamic  weighting  on 
control  usage  to  minimize  high  gain  at  high  frequency,  and  the  other  was  to  "manually" 
grab  the  high  frequency  poles  in  the  controller  and  place  them  at  lower  frequency,  thus 
rolling  off  the  controller  immediately  after  the  bandwidth.  Figure  4-7  compares  the 
magnitude  frequency  responses  of  the  original  controller,  the  controller  yielded  from  the 
dynamic  weighting  Wrz  design,  and  the  controller  resulting  from  placing  the  poles 
manually.5  Table  4-1  shows  the  gain  margin,  phase  margin,  and  the  bandwidth.  For 
positive  feedback,  the  gain  and  phase  margins  are  taken  from  the  open  loop  system 
-GpGc.  while  the  bandwidth  is  defined  as  the  0  dB  cross-over  frequency  coc  of  \-GpGc\. 
Reducing  high  frequency  control  power  has  a  negative  effect  of  reducing  robustness,  but 
the  gain  and  phase  margins  are  adequate  for  all  the  controllers.  The  pole  placement 

5 The  controllers  have  been  rescaled  to  include  the  106  gain. 
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controller  had  the  best  simulated  performance  of  all  three,  and  thus  was  chosen  as  the 
final  design  for  the  azimuth  axis  controller. 

The  next  two  sections  elaborate  on  the  methods  used  to  reduce  the  high  frequency 
gain  of  the  original  H2  controller. 


Figure  4-7  Controller  Magnitude  Frequency  Response 


Table  4-1  Unity  Feedback  Controller  Comparison 


Controller  Design 

Gain  Margin 
(dB) 

Phase  Margin 
(Degree) 

0)c 

(rad/sec) 

Original  H2 

(-11.7,  16) 

±50 

52 

Control  Usage  Weighting  Wrz 

(-10.8,  15) 

±42 

48 

Final 

(-10.5,  11) 

±36 

52 

4.4.3. 1  Control  Use  Weighting.  The  weightings  used  for  the  original  H2 
design  did  not  put  any  restriction  on  high  frequency  control  use.  As  such,  they  met  all  the 
objectives  stressed  by  the  weightings,  but  the  controller  contained  high  gain  at  high 
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frequency.  By  using  a  dynamic  weighting  on  control  usage  Wrz,  shown  in  Figure  4-8,  the 
minimization  of  high  frequency  control  usage  was  achieved.  A  second  order  weighting 
would  have  rolled  the  controller  off  quicker  without  effecting  bandwidth;  however,  the 
compensator  would  have  been  6th  order.  Being  that  it  was  desirable  to  keep  the  order  to  a 
minimum  and  that  this  was  a  relatively  simple  SISO  system,  there  was  a  more  effective 
way  of  rolling  off  the  controller. 


Frequency  (rad/sec) 

Figure  4-8  Control  Usage  Weighting 

4.4.3. 2  "Manual"  Pole  Placement.  A  closer  look  at  the  compensator  yielded 
by  H2  optimization,  after  rescaling,  revealed  that  a  complex  pair  of  poles  were  placed  at 
high  frequency. 


Gc{s)  = 


-4. 5342  x  1 01 2  (^ +.  0 1 3462  )(r  +  29. 45  +  44 1. 1 073) 
(5+.0001)(5+.99996)(r  +  443295  +  1.002624  x  109) 


(4.8) 


After  carefully  decreasing  the  frequency  of  the  complex  pair,  keeping  the  damping  ratio 
of  the  complex  pair  and  system  bandwidth  the  same,  and  keeping  the  gain  and  phase 
margins  acceptable,  the  resulting  controller  was 


Gc(s)  = 


-360  x  106(5+.013462)(5:  +  29.45  +  441.1073) 
( 5 + .  (K  X)  1 )( 5 + .  99996 )  ( 5 :  +  424.v  +  90000) 


(4.9) 
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The  compensator  in  Eqn.  4.9  was  the  final  design  used  in  the  comparison  with  the  current 
controller  and  it's  performance  analysis  is  presented  in  Chapter  5.  The  rescaled  negative 
feedback  state-space  representation  of  this  controller  is  found  in  Appendix  A.  Although 
the  gain  and  phase  margins  differed  between  this  compensator  and  the  original  of  Eqn. 
4.8,  they  had  the  same  performance,  i.e.  disturbance  rejection,  speed  of  response,  and 
tracking  error,  but  the  original  design  had  substantially  more  control  power  at 
frequencies  past  the  system  bandwidth.  For  example,  comparison  of  the  two  controllers 
tracking  five  seconds  of  real  ephemeris  data  revealed  the  motor  torque  of  the  original 
controller  system  was  644  ft-lbs  RMS,  and  the  final  design  had  244  ft-lbs  RMS. 

Again,  since  this  was  a  SISO  system,  the  task  of  grabbing  the  poles  and  dragging 
them  to  lower  frequency  was  relatively  straightforward.  However,  had  this  been  a 
complex  MIMO  system,  manually  moving  the  poles  could  have  been  difficult  and 
dangerous,  because  stability  is  not  guaranteed  as  it  is  when  using  a  control  usage 
weighting  and  H2  optimization. 

4.5  Two-Degree  of  Freedom  Controller  Design 

Figure  4-9  shows  the  two-degree  of  freedom  controller  design  setup,  where  the 
track  weighting  W,  was  used  to  minimize  tracking  error  and  indirectly  to  yield  good 
disturbance  rejection.  The  disturbance  coloring  filter  Wj  and  the  control  weightings  Rz 
and  H  had  the  same  values  as  those  used  in  the  unity  feedback  design.  W,  was  designed 
with  high  gain  at  low  frequency  to  emphasize  step  and  ramp  tracking.  Two  of  the  more 
successful  W,  designs  are  presented:  the  first  had  a  low  frequency  gain  of  60  dB  and  a 
stable  pole  at  10*3  rad/sec;  the  second  had  a  low  frequency  gain  of  180  dB,  one  stable 
pole  at  10'5  rad/sec,  and  another  stable  pole  at  10-3  rad/sec.  The  latter  is  shown  in  Figure 
4-10.  The  double  pole  W,  yielded  a  system  with  higher  gain  at  low  frequency  while 
maintaining  the  same  bandwidth. 
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Figure  4-9  Two  Degree  of  Freedom  Controller  Setup 


Frequency  (rad/sec) 


Figure  4-10  2nd  Order  Track  Weighting 

Gain  and  phase  margins  and  bandwidth,  listed  in  Table  4-2,  for  the  two  degree  of 
freedom  controller  are  dependent  on  the  feedback  loop  of  -GpGc\ ;  the  preprocessor  Gc2 
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does  not  effect  system  stability.  The  margins  we.  e  adequate  and  the  bandwidth  was 
sufficient  for  speed  of  response  and  disturbance  rejection. 


Table  4-2  Two  Degree  of  Freedom  Controller  Comparison 


Controller  Design 

Gain  Margin 
(dB) 

Phase  Margin 
(Degree) 

COc 

(rad/sec) 

1 1 st  Order  Wt 

(-11.8,  20) 

±51 

46 

|  2nd  Order  Wt 

(-7.5,  20) 

±50 

47 

Figures  4-11  and  4-12  show  the  step  and  ramp  responses  of  both  controller  designs, 
respectfully.  The  1st  order  weighting  yielded  a  system  with  a  fast,  well  damped  step 
response;  however,  the  ramp  tracking  response  had  an  extremely  large  steady  state  error. 
The  2nd  order  weighting  yielded  a  system  with  a  fast,  poorly  damped  step  response  and  a 
ramp  response  with  acceptable  steady  state  error  of  approximately  1  prad.  The  steady 
state  error  is  clearly  seen  in  Figure  4-13,  where  the  ramp  response  had  been  truncated  to 
remove  the  initial  transient  response.  Figure  4-14  shows  the  tracking  error  to  ephemeris 
command  input.  The  truncated  data  from  the  ephemeris  command  tracking  error 
response  shown  in  Figure  4-15  revealed  that  even  the  2nd  order  track  weighting  system 
had  poor  steady  state  error.  A  third  order  track  weighting  design  was  attempted  to  cope 
with  ephemeris  tracking,  but  was  unsuccessful.  A  gimbal  velocity  initial  condition  was 
given  in  the  simulation  of  the  ramp  and  ephemeris  command  input  to  prevent  the  initial 
transient  from  being  too  severe.  As  seen  in  the  figures,  the  initial  transients  were  still 
extremely  large.  Therefore,  even  if  the  steady  stale  error  was  adequate,  none  of  the  two 
degree  of  freedom  designs  were  acceptable  for  ramp  or  ephemeris  command  tracking. 
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Figure  4-11  Step  Response 
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Figure  4-12  Tracking  Error  to  Ramp  Command 
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Figure  4-13  Truncated  Tracking  Error  to  Ramp  Command 
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Figure  4-14  Tracking  Error  to  Ephemeris  Command 
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V.  Azimuth  Axis  Simulations  and  Results 


5.1  Introduction 

This  chapter  provides  detailed  comparison  of  the  final  azimuth  axis  H2  optimization 
unity  feedback  controller  and  the  azimuth  axis  controller  currently  being  used  at  the  SBD. 
Comparison  is  based  on  simulations  performed  with  the  controllers  and  the  SBD  truth 
model  developed  in  Chapter  2.  The  Simulink  models  used  for  simulations  are  shown  in 
Appendix  C,  and  a  tutorial  on  the  execution  of  the  models  is  included  in  Appendix  D. 

5.2  Controller  Comparison 

The  open-loop  Bode  frequency  responses  of  Gp(s)Gc(s)  for  the  current  SBD 
system  and  -Gp(s)Gc(s)  for  the  H2  system  are  shown  in  Figures  5-1  and  5-2,  where  Gp(s) 
is  the  truth  model.  Recalling  that  the  H2  controller  is  based  on  positive  feedback,  the 
open-loop  Bode  frequency  response  is  defined  as  -Gp(s)Gc(s).  The  current  SBD  system 
is  very  robust  with  gain  margins  of  (-35  dB,  16  dB)  and  phase  margin  ±  60°.  The  system 
with  the  H2  controller  is  not  as  robust,  but  has  adequate  gain  margins  of  (-10.5  dB,  1 1 
dB)  and  phase  margin  ±  36°.  The  bandwidths  for  the  current  and  H2  systems  are  49.7 
rad/sec  or  7.9  Hz  and  51.6  rad/sec  or  8.2  Hz,  respectively. 


5-1 


Phase  (deg)  Gain  (dB) 


Frequency  (rad/sec) 

Figure  5-1  Bode  Magnitude  Frequency  Response 
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Figure  5-2  Bode  Phase  Frequency  Response 
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5.2.1  Current  SBD  Controller.  The  current  SBD  azimuth  axis  controller  is 


described  by  the  transfer  function 


Gc(s)  = 


106(s  4-0.3)(s  +  8.1) 
5(5  +  256) 


(5.1) 


The  controller  is  designed  in  a  classical  sense  in  that  it  consists  of  PI  control  and  a  lead, 
where  high  gain  and  the  lead  are  required  to  achieve  the  necessary  bandwidth  for  speed  of 
response  and  plant  disturbance  rejection,  and  the  integrator  is  necessary  to  provide  a  near 
type  3  system  to  track  the  parabolic  ephemeris  command  with  zero  steady  state  error. 
"Near"  type  3  is  used  to  describe  the  system  because  the  gimbal  dynamics  have  one  pure 
integrator  and  one  "near"  integrator,  a  low  frequency  pole  due  to  the  damping  effect  of 
viscous  friction  as  described  in  Chapter  2. 

An  integrator  in  the  compensator  is  also  needed  to  reject  the  non-linear  bearing 
friction.  When  the  bearings  are  rolling  the  constant  running  friction  torque  Tc  of  16  ft-lbs 
is  like  a  step  torque  disturbance  input.  The  definition  of  system  type  for  unity  feedback  is 
based  on  the  reference  command  input  to  the  controller,  not  as  an  input  disturbance  to  the 
plant;  therefore,  even  though  the  gimbal  is  practically  a  double  integrator  it  does  not 
necessarily  yield  zero  steady  state  error  to  a  step  torque  disturbance.  It  can  be  seen  from 
Eqn.  5.2  that  Gc(s)  must  contain  an  integrator  to  achieve  zero  steady  state  error  to  a  step 
torque  disturbance  input. 


errss  =  J'm  s 
s-*  0 

5.2.2  H2  Optimization  Controller.  Again,  it  is  pointed  out  that  the  final  controller 
used  for  comparison  and  contrast  with  the  current  controller  was  obtained  by  placing  the 
high  frequency  poles  of  the  original  H2  design  at  lower  frequency,  as  described  in  Section 


4.4. 3. 2.  The  controller,  repeated  as  Eqn.  5.3,  is  similar  to  the  current  controller  in  that  it 
has  high  gain  and  leads  to  achieve  the  bandwidth  necessary  for  speed  of  response  and 
disturbance  rejection.  Although  it  does  not  contain  a  free  integrator,  it  does  have  a  "near" 
integrator  that  proved  to  yield  more  than  adequate  steady  state  error  to  a  pure  ramp  and 
constant  torque  disturbance  Tc  input.  Simulation  indicated  that  the  steady  state  error  due 
to  a  pure  ramp  input  was  less  than  .05  prad  and  was  also  less  than  .05  (irad  due  to  7V. 


Gc(s)  = 


-360  x  106(s+.013462)(r  +  29.4s  +  441.1073) 
(s+.0001)(s+.99996)(s:  +  424s +  90000) 


(5.3) 


5.3  Simulations  and  Results 

Simulations  were  performed  with  the  torque  disturbance  input  wj,  the  sensor  noise 
input  m'2<  step,  ramp,  and  ephemeris  command  inputs  as  described  in  Section  4.3,  and  the 
non-linear  bearing  friction  torque  disturbance  Tc.  The  inputs  were  simulated  separately  to 
determine  the  individual  effects,  and  combinations  of  the  inputs  were  simulated  to 
determine  the  total  system  performance. 

5.3. 1  Torque  Disturbance  and  Sensor  Noise.  The  simulated  torque  disturbance 
driven  by  zero  mean,  unit  intensity,  white  Gaussian  noise,  and  shaped  by  WV,  had  the 
time  response  shown  in  Figure  5-3.  The  position  error  due  to  the  torque  disturbance  is 
shown  in  Figure  5-4.  The  current  and  H2  systems  had  2. 12  and  0.47  prad  RMS  of 
position  error,  respectively.  The  disturbance  rejection  transfer  function  with  units  of 
prad  per  ft-lb  is  shown  in  Figure  5-5.  It  is  clear  that  the  H2  controller  had  better 
disturbance  rejection.  However,  as  stated  earlier  the  torque  disturbance  was  modeled 
conservatively;  therefore,  the  error  due  to  torque  disturbance  may  not  be  as  severe  in  the 
actual  SBD  system. 
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Figure  5-3  Torque  Disturbance 
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Figure  5-4  Position  Error  to  Torque  Disturbance 
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Figure  5-5  Torque  Disturbance  Rejection  Transfer  Function 

Sensor  noise  was  simulated  with  zero  mean,  unit  intensity,  white  Gaussian  noise, 
and  filtered  to  prevent  the  unrealistic  driving  of  high  frequency  control  power.  The 
position  error  due  to  sensor  noise  was  approximately  0.3  prad  RMS  for  both  systems. 

5.3.2  Step  Response.  Figure  5-6  shows  the  responses  to  a  100  (irad  step  input,  and 
Figure  5-7  is  the  closed-loop  transfer  function  6(s)/6c(s)  of  the  two  systems.  The  H2 
system  had  a  2%  settling  time  of  approximately  300  msec.  The  current  controller  had  a 
29c  settling  time  of  250  msec  and  was  better  damped  with  a  damping  ratio  of  0.6 
compared  with  0.3  for  the  H2  system.  Although  analysis  of  voltage  saturation  (±  10 
volts)  was  not  performed,  both  systems  would  have  saturated  with  a  100  |irad  step.  The 
current  system  required  approximately  50%  more  control  power  than  the  H2  system  to 
achieve  the  well  damped  performance;  therefore,  had  saturation  been  modeled,  saturation 
for  the  current  system  would  have  been  more  severe.  Greater  saturation  results  in  more 
overshoot  and  longer  settling  time  [2:217-218].  Therefore,  the  well  damped  response 
does  not  necessarily  mean  that  the  current  controller  is  a  better  design  for  step  inputs. 
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Figure  5-6  Step  Response 
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Figure  5-7  Closed-Loop  Transfer  Function 


5.3.3  Ramp  Response.  As  described  in  Section  1 .4,  bang-bang  control  is  used  to 
move  the  gimbal  large  distances.  Thus,  by  the  time  control  is  switched  to  the  fine  position 
loop,  the  gimbal  will  have  some  initial  velocity.  To  make  the  simulation  more  realistic  an 
initial  velocity  condition  is  given.  Actually,  all  the  states,  including  the  controller  state, 
will  have  initial  conditions,  but  experimenting  with  the  initial  conditions  indicated  that 
only  the  velocity  initial  condition  was  important.  The  first  simulation  presented  was  done 
without  an  initial  condition  for  the  purpose  of  contrasting  a  key  difference  between  the 
two  controllers.  Figure  5-8  revealed  that  the  amplitudes  of  the  initial  transients  were 
about  the  same  for  both  systems.  In  Figure  5-9  the  initial  transient  response  was  removed 
by  truncating  the  data  to  get  a  closer  look  at  the  steady  state  error.  The  H2  controller 
produced  near  zero  steady  state  error  within  300  msec,  while  the  current  system  had  a 
settling  time  of  greater  than  10  seconds.  This  was  the  most  significant  difference 
between  the  two  controllers. 
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Figure  5-8  Ramp  Command  Tracking  Error 
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Figure  5-9  Truncated  Ramp  Command  Tracking  Error 


The  ramp  command  input  has  a  slope  of  0.1  rad/sec;  therefore,  the  next  simulation 
included  an  initial  velocity  of  0. 1  rad/sec.  The  simulation  also  included  the  effects  of  the 
constant  torque  disturbance  Tc.  It  would  have  been  more  realistic  to  pick  an  initial 
velocity  less  that  0.1  rad/sec,  but  to  clearly  illustrate  the  effects  of  bearing  friction  it  was 
necessary  to  keep  the  initial  transient  to  a  minimum.  Figure  5-10  and  Figure  5-1 1 
compare  the  effects  of  bearing  friction  of  the  current  and  H2  controllers,  respectively. 
Again,  the  large  settling  time  with  the  current  controller  is  seen.  Both  controllers  did  an 
adequate  job  rejecting  the  bearing  friction  torque  disturbance.  The  small  steady  state 
error  due  to  bearing  friction  with  the  H2  controller  can  be  seen  in  Figure  5-11  as  the 
difference  between  the  two  curves. 
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Figure  5-10  Bearing  Friction  Effect  With  Current  Controller 
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Figure  5-11  Bearing  Friction  Effect  With  H2  Controller 
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5.3.4  Ephemeris  Response.  It  is  necessary  at  this  time  to  make  the  distinction 
between  RMS  tracking  error  and  steady  state  tracking  error.  Pointing  and  tracking 
requirements  are  usually  split  into  two  specifications:  the  first  being  pointing  error 
defined  as  the  bias  or  mean  error,  referred  to  in  this  thesis  as  the  steady  state  error  errss\ 
the  second  is  the  tracking  jitter,  which  is  the  RMS  error  about  the  mean. 

The  simulation  presented  in  this  section  only  included  the  response  to  ephemeris 
command  input.  The  velocity  derived  from  the  ephemeris  command  data  had  an  initial 
value  of  0.0875  rad/sec;  therefore,  an  initial  condition  of  .085  rad/sec  was  given  to 
simulate  the  transient  due  to  the  hand-off  from  coarse  to  fine  control.  Figure  5-12  shows 
the  resulting  tracking  error  for  both  systems.  The  H2  system  had  a  settling  time  of  300 
msec,  errss  of  0.36  prad,  and  an  RMS  tracking  error  of  1.0  prad.  For  the  current  system,  it 
was  not  possible  to  determine  the  exact  settling  time  or  steady  state  error  from  the  five 
second  response,  but  as  was  seen  with  the  ramp  response  in  Section  5.3.3  the  settling  time 
was  at  least  10  seconds  and  the  steady  state  error  was  asymptotically  approaching  zero. 
The  RMS  tracking  error  for  the  current  system  was  0.95  prad. 
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Figure  5-12  Ephemeris  Command  Tracking  Error 
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5.3.5  Full-Up  Simulation.  Total  system  performance  was  analyzed  in  this  section 
by  simulating  ephemeris  command  input  with  an  initial  velocity  condition  of  0.085 
rad/sec,  torque  disturbance  W],  sensor  noise  h>2,  and  bearing  friction  torque  disturbance 
Tc.  Figure  5-13  shows  the  resulting  tracking  error  for  both  systems.  The  conservatively 
modeled  torque  disturbance  was  apparent  in  the  current  system,  whereas  the  torque 
disturbance  was  effectively  rejected  in  the  H2  system.  Time  histories  and  PSD  plots  of 
all  system  signals  for  the  full-up  simulation  are  included  in  Appendix  E. 

The  accuracy  of  the  RMS  tracking  error  values  for  the  full-up  simulation  presented 
in  the  summary  section  in  Table  5-2  is  questionable.  All  of  the  RMS  energy  associated 
with  the  non-rejected  low  frequency  torque  disturbance  was  not  captured  in  the  5  second 
sample  of  data.  Therefore,  the  RMS  values  given  were  smaller  than  they  would  have 
been  had  the  simulation  been  run  longer.  A  five  second  sample  of  ephemeris  data  was 
the  longest  available.  However,  since  the  torque  disturbance  was  modeled  conservatively 
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this  is  not  an  important  issue.  Also,  the  point  of  the  simulation  was  to  compare  the  two 
controllers,  and  clearly  the  H2  controller  had  the  better  disturbance  rejection  and 
ephemeris  tracking  performance. 
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Figure  5-13  Full-Up  Simulation  Tracking  Error 


5.3.6  Summary  of  Results.  Tables  5-1  and  5-2  are  the  compiled  results  from  all 
simulations.  Although  the  current  system  had  a  better  step  response,  the  H2  controller 
proved  to  yield  better  overall  performance,  especially  in  the  "true  test  of  performance"  of 
ephemeris  tracking.  One  might  think  that  the  high  price  to  pay  for  the  better  tracking 
performance  would  have  been  more  control  usage;  however,  as  seen  in  the  motor  torque 
RMS  values,  the  H2  controller  required  only  10%  more  control  power  than  the  current 
controller. 
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Table  5-1  Simulation  Results 


Simulation 

Settling 

Time 

Over¬ 

shoot 

RMS  err 
((-trad) 

errss 

Utrad) 

Torque  Disturbance 

|  Current  Controller 

2.12 

H2  Controller 

0.47 

Sensor  Noise 

Current  Controller 

0.30 

H2  Controller 

0.30 

|  Bearing  Friction 

Current  Controller 

=0 

H2  Controller 

<0.05 

Step  Response 

Current  Controller 

250  msec 

10% 

0.0 

H2  Controller 

300  msec 

40% 

Ramp  Response 

j  Current  Controller 

=  10  sec 

approaches  0 

H2  Controller 

300  msec 

<0.05 

Ephemeris  Response 

Current  Controller 

=  10  sec 

0.95 

H2  Controller 

300  msec 

1.0 

0.36 

Table  5-2  Full-Up  Simulation  Results 


Full-Up  Simulation 

RMS  err 

errss 

RMS 

Mean  Value 

Current  Controller 

2.6  |irad 

|  Voltage 

0.66  volts 

0.57  volts 

Motor  Torque 

221  ft-lbs 

195  ft-lbs  | 

H2  Controller 

1.14  jirad 

0.47  firad 

Voltage 

0.60  volts 

0.56  volts 

Motor  Torque 

244  ft-lbs 

190  ft-lbs 

_ _ _ 
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VI.  Elevation  Axis 


6.1  Introduction 

As  stated  earlier,  the  emphasis  in  this  thesis  is  on  controller  design  for  the  azimuth 
axis,  and  the  elevation  axis  controller  design  is  merely  included  for  completeness.  The 
data  available  for  the  elevation  model  is  not  complete;  therefore,  many  assumptions  are 
made  in  developing  the  model.  Direct  feedforward  had  to  be  implemented  in  the  actual 
SBD  elevation  axis  control  to  achieve  adequate  tracking  for  reasons  not  even  the  SBD 
engineers  clearly  understand.  This  indicates  that  there  is  something  missing  from  the 
model  developed  in  this  thesis,  because  it  is  not  necessary  to  implement  feedforward  to 
achieve  the  tracking  requirements.  Therefore,  since  the  model  does  not  accurately 
represent  the  actual  system,  a  comparison  between  the  currently  used  elevation  axis 
controller  and  the  controller  developed  in  this  chapter  is  not  made.  However,  it  is 
important  to  present  the  elevation  axis  model  and  controller  design  to  provide  a  starting 
point  for  possible  follow-on  research. 

6.2  Elevation  Axis  Linear  Plant  Model 

Like  the  azimuth  axis,  the  elevation  axis  consists  of  the  current  loop  Gci(s),  motor 
torque  Kj,  and  the  gimbal  Gg(s).  Most  of  the  model  plant  dynamics  are  obtained  from 
the  original  coelostat  documentation  and  from  data  taken  from  the  actual  SBD  system. 
However,  the  data  is  not  complete;  therefore,  some  of  the  values  for  the  model  are 
estimated. 

The  motor  torque  constant  and  the  gimbal's  moment  of  inertia  are  given  in  the 
documentation  as  Kj-  19.5  ft-lbs/amp  and  J  =  1700  ft-lbs-sec2.  No  value  for  the 
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coefficient  of  viscous  friction  Kv  is  given,  therefore,  Kv  is  estimated  such  that  the  viscous 
damping  is  the  same  as  it  is  in  the  azimuth  axis.  Kv  =  23  ft-lbs/rad/sec. 

The  current  loop  dynamics  are  obtained  from  frequency  response  plots  taken  from 
the  actual  system.  The  plot  was  reconstructed  in  Matlab  by  iteration  until  the  shape 
matched  the  original.  Figure  6-1  shows  that  the  current  loop  is  a  first  order  lag  system 
with  a  break  frequency  (Ob  of  approximately  300  rad/sec  and  a  gain  constant  Ka  of  9  dB  or 
2.8  amps/volt. 


Frequency  (rad/sec) 


Frequency  (rad/sec) 


Figure  6-1  Elevation  Axis  Current  Loop  Frequency  Response 


6.3  Torque  Disturbance  and  Sensor  Noise 

The  motor  cogging  and  ripple  torque  disturbances  are  estimated  to  be  10^  of  the 
magnitude  of  the  disturbance  used  for  the  azimuth  axis.  Justification  for  the  disturbance 
estimate  came  from  data  for  a  similar  beam  director  that  indicated  that  the  magnitude  of 
the  elevation  axis  disturbance  was  10^  of  that  in  the  azimuth  axis  (7:14).  Wind  buffeting 
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in  the  elevation  axis  will  also  not  be  as  severe  as  in  the  azimuth  axis.  The  torque 
disturbance  is  modeled  as  a  coloring  filter  Wd,  shown  in  Figure  6-2  ,  driven  by  zero- 
mean,  unit  intensity  ,  white  Gaussian  noise.  Wd  is  described  in  state-space  form  as 


xd(,t)  =  Adxd(t)  +  Bdwx(t) 
Td(t )  =  Cdxd(t )  +  Ddwx  ( t ) 


(6.1) 


where  Td(t)  is  the  torque  disturbance,  xjt)  is  the  disturbance  state,  and  wj(t)  is  zero-mean, 
unit  intensity,  white  Gaussian  noise.  The  state-space  values  are 


A/  =  - 1  Bd  =  ' 

Q  =  100  Dd=  0 


(6.2) 


Frequency  (rad/sec) 


Figure  6-2  Torque  Disturbance  Coloring  Filter 

No  data  is  available  on  the  bearing  friction;  therefore,  knowing  that  it  will  be  less 
than  the  bearing  friction  in  the  azimuth  axis,  it  is  modeled  as  Tc  =  8  ft-lbs. 

The  elevation  gimbal  position  is  measured  using  an  Inductosyn  encoder.  The 
measurement  of  true  angular  position  is  corrupted  by  zero  mean,  white  Gaussian  noise 
with  an  RMS  of  .2  arc  seconds  or  1  ^trad  and  is  modeled  as  such  for  the  controller  design. 
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6.4  Nominal  and  Truth  Models 

The  nominal  model  includes  the  current  loop  gain  constant  Ka,  motor  torque 
constant  Kj,  gimbal  dynamics  Gg(s) ,  torque  disturbance  input  Td(t),  and  zero-mean, 
white  Gaussian  noise,  of  1  |irad  intensity  sensor  noise.  The  state-space  representation  of 
the  nominal  plant  is 


8(f) 

0(f) 


'0 

0 


1 

-K, 


'0(f)' 

0(f) 


0 

lKrKa 


v(r) 


0(f)  =  [1 


+  [0]v(f) 


(6.3) 


or 


xp(t)  =  Apxp(t)  +  Bpup(t) 
yp(t)  =  Cpxp(t)  +  DpUp(t) 


(6.4) 


The  truth  or  simulation  model  includes  the  nominal  model  plus  the  dynamics  of  the 
current  loop  Gci(t),  non-linear  bearing  friction,  first  order  Pade1  approximation  to  a  ZOH, 
and  the  sensor  noise  is  rolled  off  at  40  dB  per  decade.  The  elevation  axis  parameter 
values  are  summarized  in  Table  6-1. 
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Table  6-1  Elevation  Axis  Parameters 


|  Parameter 

Value 

Moment  of  Inertia  (ft-lbs-sec2) 

J 

mam 

Coefficient  of  Viscous  Friction  (ft-lbs/rad/sec) 

Kv 

23 

Motor  Torque  Constant  (ft-lbs/amp) 

kt 

19.5 

Sample  Period  (sec) 

T 

0.005 

Current  Loop  Gain  Constant  (amp/volt) 

Ka 

2.8 

Current  Break  Frequency  (rad/sec) 

COb 

300 

Bearing  Friction  Torque  Constant  (ft-lbs) 

Tc 

8 

6.5  Elevation  Axis  Controller  Design 

The  same  unity  feedback  setup  used  for  the  azimuth  axis  controller  design  is  used 
for  the  elevation  design.  As  in  the  azimuth  axis  design  Rz  is  chosen  to  be  1  and  H  is  a  2 
by  2  identity  matrix.  The  final  sensitivity  weighting  Ws ,  chosen  to  achieve  the 
performance  requirements  of  disturbance  rejection  and  command  tracking,  is  shown  in 
Figure  6-3  and  its  state-space  representation  is 


xs(t)  =  Asxs{t)  +  Bs6m(t) 
Z)  =Csxs(t)  +  Ds6m{t) 


(6.5) 


where  is  the  controller  output,  c^r)  is  the  sensitivity  weighting  state,  and  6jt)  is  the 
measured  gimbal  position.  The  state-space  values  are 


As  =-0.0001  fl,=l 
C5=.  5  Ds=() 


(6.6) 
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Frequency  (rad/sec) 
Figure  6-3  Sensitivity  Weighting 


The  state-space  description  of  the  resulting  controller  is  contained  in  Appendix  A. 
The  system  had  gain  and  phase  margins  of  (-1 1.1  dB,  20  dB)  and  ±43°,  and  a  bandwidth 
of  49  rad/sec.  Like  the  azimuth  axis  H2  optimization  put  a  pair  of  complex  poles  at  high 
frequency  resulting  in  more  high  frequency  control  power  than  was  necessary  for  the 
required  system  performance.  The  high  frequency  poles  could  be  moved  to  a  lower 
frequency  without  decreasing  system  performance  or  decreasing  the  gain  and  phase 
margins  below  acceptable  values. 

6.6  Simulation  and  Results 

Simulations  were  performed  with  the  truth  model.  The  disturbance  rejection 
transfer  function,  shown  in  Figure  6-4,  was  not  as  good  as  it  was  in  the  azimuth  axis. 
This  is  to  be  expected,  because  the  moment  of  inertia  of  the  azimuth  axis  is  15  times 
greater  than  that  of  the  elevation  axis,  thus  making  it  naturally  more  resistant  to  torque 
disturbances.  Even  though  the  input  torque  disturbance  was  modeled  as  10%  of  that  in 
the  azimuth  axis,  the  position  error  due  to  torque  disturbance  was  greater  in  the  elevation 
axis;  err  =0.78  prad  RMS.  However,  the  disturbance  rejection  was  still  more  than 
adequate. 
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Figure  6-4  Torque  Disturbance  Rejection  Transfer  Function 

In  general,  the  elevation  rate  of  a  satellite  ephemeris  vector  is  considerably  less  than 
the  azimuth  rate  for  an  elevation  over  azimuth  beam  director.  The  elevation  position 
ephemeris  had  an  average  rate  of  0.007  rad/sec  compared  to  0.1  rad/sec  for  the  azimuth 
position  ephemeris  .  Therefore,  the  tracking  environment  for  the  elevation  axis  is  not  as 
severe  and  is  evident  in  the  time  response  shown  in  Figure  6-5.  Even  with  no  initial 
velocity  condition  given,  the  initial  transient  was  not  too  severe,  the  RMS  jitter  and  errss 
were  only  0.06  and  0.05  prad,  respectively.  The  full-up  simulation  of  ephemeris 
command  input,  torque  disturbance,  bearing  friction  disturbance,  and  sensor  noise  yielded 
RMS  jitter  and  errss  of  1.0  and  0.62  prad,  respectively. 
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VII.  Conclusions/Recommendations 


7.1  Conclusions 

The  two  objectives  of  this  thesis  were  met:  a  controller  for  the  azimuth  axis  was 
designed  that  had  better  performance  than  the  currently  used  controller,  and  optimal 
control  was  used  to  develop  the  controller. 

The  modeling  (including  the  plant,  disturbances,  and  sensor  noise)  and  defining 
system  requirements  proved  to  be  the  most  difficult  tasks  in  designing  the  controller. 
Since  the  model  was  a  SISO  system,  classical  design  techniques  could  have  been  used  to 
design  a  controller  with  better  ramp  tracking  performance  than  the  currently  used 
controller,  because  it  appears  that  the  original  design  was  based  on  step  response 
performance  and  not  ramp  tracking  performance.  The  optimal  control  design  techniques 
proved  to  be  no  more  difficult  than  a  classical  approach,  because  once  the  optimal  control 
problem  was  set  up  and  it  was  understood  how  the  control  weightings  affect  system 
performance,  it  was  relatively  straightforward  to  "dial"  the  weightings  to  "tune"  system 
performance. 

7.1.1  Azimuth  Axis  Performance.  The  currently  used  controller  yielded  a  system 
with  better  robustness  than  the  H2  controller.  However,  the  gain  and  phase  margins  for 
the  H2  system  were  more  than  adequate. 

The  H2  controller  produced  better  disturbance  rejection  than  the  currently  used 
controller.  However,  as  stated  in  Section  5.3.1  the  disturbance  in  the  actual  SBD  system 
may  not  be  as  severe  as  the  modeled  disturbance;  therefore,  a  controller  with  better 
disturbance  rejection  may  not  be  necessary. 
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The  currently  used  controller  yielded  a  better  damped,  slightly  faster,  step  response 
than  the  H2  controller.  However,  this  is  not  necessarily  an  advantage  for  three  .easons: 
first,  as  described  in  section  5.3.2  the  current  controller  requires  more  control  power  for 
step  command  following,  and  thus  would  have  a  larger  saturation  problem;  second,  the 
true  test  of  performance  is  tracking  ephemeris  commands  which  are  more  akin  to  ramp 
commands  than  step  commands;  and  third  step  commands  are  more  realistically  a  job  for 
the  coarse  position  loop  or  "bang-bang"  controller. 

The  most  important  difference  between  the  two  controllers  was  in  their  ability  to 
track  ramp  or  ephemeris  commands.  The  settling  time  to  achieve  near  zero  steady  state 
error  for  the  H2  system  was  300  msec,  while  the  settling  time  for  the  current  system  was 
greater  than  10  seconds. 

7.1.2  The  Price  to  Pay.  The  most  obvious  difference  between  the  two  controllers 
is  that  the  currently  used  controller  is  2nd  order  and  the  H2  controller  is  4th  order. 
Generally,  optimal  control  produces  high  order  controllers.  However,  if  classical  control 
design  had  been  used  to  develop  a  controller  with  the  same  tracking  performance  as  the 
H2  controller,  it  is  likely  that  it  would  have  been  higher  than  2nd  order. 

The  gimbal  has  resonant  frequencies  at  14,  30,  and  45  Hz,  or  88,  188,  and  282 
rad/sec,  respectively.  Notch  filters  were  implemented  on  the  current  SBD  system  to 
account  for  the  gimbals  natural  modes.  If  the  H2  controller  is  implemented  on  the  SBD, 
notch  filters  will  also  have  to  used.  As  described  in  Section  4.4.2.2,  the  high  frequency 
poles  of  the  H2  controller  were  moved  to  roll  off  the  controller  to  minimize  high 
frequency  control  use  that  would  drive  the  resonant  frequencies.  As  seen  in  the  closed- 
loop  transfer  function  9(t)/dc(t ),  Figure  7-1,  the  final  H2  controller  still  has  more  gain 
than  the  current  controller  out  to  300  rad/sec.  Placing  the  poles  at  an  even  lower 
frequency  to  roll  off  the  compensator  will  have  many  adverse  effects;  lower  bandwidth, 
lower  gain  and  phase  margins,  and  less  damping.  The  notch  filtering  will  be  a  more 
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difficult  task  with  the  H2  controller  for  the  resonant  frequencies  of  88  and  188  rad/sec, 
because  the  gain  is  higher  than  the  current  system  at  those  frequencies. 


l()o  101  102  103 

Frequency  (rad/sec) 

Figure  7-1  Closed-Loop  Transfer  Function 


7.2  Future  Research 

Better  understanding  of  the  elevation  axis  dynamics  and  the  coupling  between  the 
azimuth  and  elevation  axes  would  enable  one  MIMO  system  model  to  be  built.  The  two 
inputs  would  be  azimuth  and  elevation  position  commands  and  the  two  outputs  would  be 
the  measured  azimuth  and  elevation  positions.  The  resulting  controller  would  be  a 
coupled  2  by  2  matrix  controller.  The  challenge  would  be  to  utilize  the  true  advantage  of 
optimal  control  design  for  a  MIMO  system  and  provide  the  SBL>  with  a  controller  that 
addresses  the  coupling  problem. 

One  of  the  original  objectives  of  this  thesis  was  to  use  both  H2  and  H  00  optimization 
for  the  controller  design  and  compare  and  contrast  the  two.  However,  the  scaling 
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problem  described  in  Section  4.2  prevented  completely  successful  H  oo  optimization 
results.  An  H<»  synthesized  controller  was  designed  with  marginal  performance,  and 
more  effort  would  have  eventually  yielded  an  adequate  controller.  However,  even  if  a 
successful  Hoo  design  was  achieved,  the  comparison  would  have  been  difficult  at  best, 
because  the  scaled  plant  used  for  Hoo  optimization  was  drastically  different  than  the 
scaled  plant  used  for  H2  optimization.  Further  investigation  is  needed  to  determine  the 
cause  of  the  numerical  problems  Hoo  has  with  this  model,  and  to  determine  the  proper 
scaling  necessary  to  develop  a  controller  with  good  performance.  It  may  have  been 
possible  to  develop  an  adequate  controller  of  the  uncoupled  SISO  system,  but  a  much 
better  understanding  of  the  Hoo  numerical  problems  will  be  necessary  to  develop  a 
controller  for  a  coupled  MEMO  system. 

The  most  interesting  suggested  follow-on  research  is  to  design  a  two  degree  of 
freedom  controller  for  the  SBD  model  that  has  better  performance  than  the  unity 
feedback  controller  for  ramp  or  ephemeris  command  tracking.  A  two  degree  of  freedom 
controller  has  more  flexibility  than  a  unity  feedback  controller  and  theoretically,  should 
provide  at  least  as  good  if  not  better  tracking  performance.  One  of  the  two  degree  of 
freedom  controllers  designed  in  this  thesis  did  yield  a  faster,  better  damped  step  response 
than  the  unity  feedback  controller.  However,  ramp  tracking  was  non-existent  and  efforts 
to  better  the  performance  by  changing  the  track  weighting  were  less  than  completely 
successful.  "Dialing"  of  the  track  weighting  VT,  was  exhausted  to  achieve  the  desired 
performance  of  fast,  well  damped,  zero  steady  state  error  ramp  tracking,  while 
maintaining  the  well  damped  step  response.  Other  weightings  in  conjunction  with  the 
track  weighting,  such  as  a  sensitivity  weighting  and  a  weighting  on  the  command  input, 
were  also  attempted  to  no  avail.  In  order  to  get  the  two  degree  of  freedom  controller  to 
yield  adequate  performance  alternate  approaches  need  to  be  investigated. 
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7.3  Closing  Comments 

This  thesis  demonstrates  that  optimal  control  design  is  a  powerful  tool  that  can  be 
used  not  only  to  achieve  robustness  but  also  microradian  tracking  performance.  The 
ultimate  test  of  performance  would  be  to  integrate  the  discretized  azimuth  axis  H2 
controller  into  the  SBD.  Obviously,  that  decision  will  be  made  by  the  SBD  engineers 
who  have  to  determine  if  the  improved  performance  demonstrated  in  this  thesis  is  worth 
the  effort. 
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Appendix  A:  Final  Compensator  Design 


A.l  Azimuth  Axis  Compensator 

Transfer  function  form  of  negative  feedback  controller: 


Gc(s )  = 


360  x  106  (s+. 0 1 3462)(s  2  +  29. 4  j  +  44 1. 1 073) 
(s+.  000 1 )($+.  99996 )(s2  +  424s  +  90000) 


State-space  form: 


Gc(s )  =  Cc(sl  -  Ac)_1  Bc  +  Dc 
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A.2  Elevation  Axis  Compensator 
State-space  form: 
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Appendix  B:  Matlab  M-Files 


B.l  Introduction 

M-files  were  used  extensively.  Data,  such  as  model  parameter  values  were  stored 
in  M-files  as  opposed  to  data  or  MAT-files.  It  was  easier  to  edit  an  M-file  where  a 
parameter  and  its  value  were  clearly  displayed.  Simply  typing  the  M-file  name  loaded  its 
parameter  contents  into  the  Matlab  work  space.  The  comment  sign  "%"  was  also  used 
extensively  not  only  to  add  descriptive  comments,  but  to  comment  out  certain  commands 
that  were  not  wished  to  be  executed  for  a  particular  analysis.  Contained  in  this  appendix 
is  a  list  of  all  M-files  and  a  short  description  used  in  the  execution  of  this  thesis,  and  a 
print  out  of  some  of  the  key  M-files. 


B.2  List  of  M-files 

M-Files 

ave-  Calculates  the  average  or  mean  value  of  a  time  history. 

azplant  -  Contains  all  the  azimuth  axis  plant  parameter  values,  and  builds  state-space 
form  of  the  nominal  and  truth  models. 

cctoteval  -  Creates  linear  state-space  model  of  Simulink  model  "SimCCTotEvalMod"  for 
the  currently  used  controller  to  calculate  the  closed-loop  transfer  function  and  the 
disturbance  rejection  transfer  function.  Also  calculates  Bode  frequency  response 
and  gain  and  phase  margins  of  Gp(s)Gc(s).  where  Gp(s)  is  the  truth  model. 

cesca  -  executes  the  sequence  of  M-files;  pbazsw!5,  H2 ,  sentoteval,  which,  builds  the  P 
matrix,  calculates  the  H2  optimal  controller,  and  plots  the  Bode  frequency  plot  of 
-Gp(s)Gc(s). 

classcntr  -  builds  the  currently  used  controller  state-space,  plots  Bode  frequency 

response,  and  calculates  gain  and  phase  margin  from  Gp(s)Gc(s),  where  Gp(s)  is 
the  truth  model. 

comproll  -  builds  the  Final  controller  state-space. 

elplant  -  Contains  all  the  elevation  axis  plant  parameter  values,  and  builds  the  nominal 
and  truth  models. 

H2  -  Calls  the  h2opt  and  split  M-files  to  calculate  the  optimal  controller  and  split  it  into 
its  state-space  form  Ac,  Be,  Cc,  Dc. 

h2opt  -  H2  optimization  algorithm 

Hin  -  Calls  the  hinf5  M-file  to  calculate  the  Hco  optimized  controller. 


B-l 


hinf5-  Hoo  optimization  algorithm 

param  -  Builds  state-space  of  torque  disturbance  coloring  filter,  sensor  noise  shaping 
filter,  and  all  weightings. 

pbazswl-14  -  Builds  azimuth  axis  P  matrix  for  various  unity  feedback  setups  with  2nd 
and  3rd  order  sensitivity  and  complementary  sensitivity  weightings 
pbazswlS  -  Builds  azimuth  axis  P  matrix  for  the  final  unity  feedback  design  with  a  1st 
order  W* 

pbaztwl-12  -  Builds  azimuth  axis  P  matrix  for  various  2  degree  of  freedom  controller 
setups  with  weightings  Wf,  Vkj,  and  input  weighting  Wr. 
pbaztwl3  -  Builds  azimuth  axis  P  matrix  for  2  degree  of  freedom  controller  setup  with 
1st  order  W, 

pbaztwM  -  Builds  azimuth  axis  P  matrix  for  2  degree  of  freedom  controller  setup  with 
2nd  order  Wt 

pbelsw2  -  Builds  elevation  axis  P  matrix  for  the  final  elevation  axis  unity  feedback 
design  with  a  1st  order  Ws 
psd  -  Calculates  RMS  and  Plots  PSD  of  a  vector. 
scale3  -  Performs  internal  scaling  of  the  optimal  control  setup 
sentoteval  -  Creates  linear  state-space  model  of  Simulink  model  "SimSenTotEvalMod" 
for  the  unity  feedback  design  to  calculate  the  closed-loop  transfer  function  and  the 
disturbance  rejection  transfer  function.  Also  calculates  Bode  frequency  response 
and  gain  and  phase  margins  of  -Gp(s)Gc(s).  where  Gp(s)  is  the  truth  model. 
split  -  Slits  the  H2  optimal  controller  Pc  into  Ac,  Be,  Cc,  Dc. 

trektoteval  -  Creates  linear  state-space  model  of  Simulink  model  "SimTrckTotEvalMod" 
for  the  2  degree  of  freedom  controller  design  to  calculate  the  closed-loop  transfer 
function  and  the  disturbance  rejection  transfer  function.  Also  calculates  Bode 
frequency  response  and  gain  and  phase  margins  of  ~Gp(s)Gc(s).  where  Gp(s)  is 
the  truth  model. 

truncate  -  truncates  all  of  the  time  histories  generated  from  a  Simulink  simulation  to 
eliminate  the  initial  transient  response  from  a  5  second  simulation. 
truncatetensec-  truncates  all  of  the  time  histories  generated  from  a  Simulink  simulation  to 
eliminate  the  initial  transient  response  from  a  10  second  simulation. 


B.3  Azimuth  Axis  Plant  "azplant" 

This  M-file  contains  all  the  azimuth  axis  parameter  values,  and  builds  the  state- 
space  nominal  and  truth  models  used  in  Hb  optimization  and  Simulink  simulation. 

M-Fjlg  azplani: 

%  Azimuth  axis  symbol  definitions  and  values 

%  Ka  -  current  loop  gain  constant  (AMP/VOLT) 

9c  Wan  -  amplifier  natural  frequency  (rad/sec) 

9c  z  -  amplifier  damping  coefficient 

9c  KT  -  motor  Torque  Constant  (ft-lbs/AMP) 

9c  J  -  gimbal  moment  of  inertia  (ft-lbs-secA2) 

9c  Kv  -  Coefficient  of  viscous  friction  (ft-lbs/rad/sec) 
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%  T  -  Sample  rate  of  digital  controller 


Ka=4.4; 

Wan=560; 

z=25; 

KT=75.6; 

J=26000; 

Kv=350; 

T=.005; 

%Aa  -  amplifier  A  matrix 
%Ba  -  amplifier  B  matrix 
%Ca  -  amplifier  C  matrix 
%Da  -  amplifier  D  matrix 

% 

Aa=[0  l;-WanA2  -2*z*Wan]; 

Ba=[0;Ka*  W  anA2] ; 

Ca=[l  0]; 

Da=  [0]; 

%Ag  -  gimbal  A  matrix 
%Bg  -  gimbal  B  matrix 
%Cg  -  gimbal  C  matrix 
%Dg  -  gimbal  D  matrix 

% 

Ag=[0  1;0  -K v/Jl; 

Bg=[0;l/J]; 

Cg=[le6  01; 

Dg=0; 

%Asd  -  Sampling  Delay  A  matrix 
%Bsd  -  Sampling  Delay  B  matrix 
%Csd  -  Sampling  Delay  C  matrix 
%Dsd  -  Sampling  Delay  D  matrix 

% 

Asd=-2/T; 

Bsd=2/T; 

Csd=l; 

Dsd=0; 

%  The  following  augmented  plant  state-space  is  for  the 

%  optimization  routines  and  therefore  does  not  include  the  current 

%  loop  dynamics.  The  current  loop  is  modeled  by  the  gain  constant  Ka. 

9c  Ap  -  plant  A  matrix 

%Bp  -  plant  B  matrix 

%Cp  -  plant  C  matrix 

%Dp  -  plant  D  matrix 

7c 
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Ap=Ag; 

Bp=KT*Ka*Bg; 

Cp=Cg; 

Dp=0; 

%  The  following  state-space  is  the  full  plant  "truth  model"  including  current  loop 
%  and  sampling  delay  dynamics 

Afp=[Asd  zeros(l,4);Ba*Csd  Aa  zeros(2,2);zeros(2,l)  Bg*KT*Ca  Ag]; 
Bfp=[Bsd;0;0;0;0] ; 

Cfp=[0  0  0  Cg]; 

Dfp=0; 


B.4  Elevation  Axis  Plant  " elplant " 

This  M-file  contains  all  the  elevation  axis  parameter  values,  and  builds  the  state- 
space  nominal  and  truth  models  used  in  H2  optimization  and  simulation. 

M-File  elplant : 

%  Elevation  axis  symbol  definitions  values  and  model 
%  Ka  -  amplifier  gain  constant  (AMP/VOLT) 

■%  Wab  -  amplifier  break  frequency  (rad/sec) 

%  KT  -  motor  Torque  Constant  (ft-lbs/AMP) 

%  J  -  gimbal  moment  of  inertia  (ft-lbs-secA2) 

%  Kv  -  Coefficient  of  viscous  friction  (ft-lbs/rad/sec) 

%  T  -  Sample  rate  of  digital  controller 
Ka=2.8; 

Wab=300; 

KT=19.5; 

J=1700; 

Kv=23; 

T=.005; 

%Aa  -  amplifier  A  matrix 
%Ba  -  amplifier  B  matrix 
%Ca  -  amplifier  C  matrix 
%Da  -  amplifier  D  matrix 

% 

Aa=[-Wab]; 

Ba=[Ka*Wab]; 

Ca=[  1  ]; 

Da=  0; 

%Ag  -  gimbal  A  matrix 
%Bg  -  gimbal  B  matrix 
%Cg  -  gimbal  C  matrix 
%Dg  -  gimbal  D  matrix 
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Ag=[0  1;0  -Kv/J]; 

Bg=[0;l/J]; 

Cg=[le6  0]; 

Dg=0; 

%Asd  -  Sampling  Delay  A  matrix 
%Bsd  -  Sampling  Delay  B  matrix 
%Csd  -  Sampling  Delay  C  matrix 
%Dsd  -  Sampling  Delay  D  matrix 

% 

Asd=-2/T; 

Bsd=2/T; 

Csd=l; 

Dsd=0; 

9c  The  following  augmented  plant  state-space  is  for  the 

%  optimization  routines  and  therefore  does  not  include  the  amplifier 

%  dynamics.  Tne  amplifier  is  modeled  by  the  gain  constant  Ka. 

%Ap  -  plant  A  matrix 

%Bp  -  plant  B  matrix 

%Cp  -  plant  C  matrix 

%Dp  -  plant  D  matrix 


Ap=Ag; 

Bp=KT*Ka*Bg; 

Cp=Cg; 

Dp=0; 

%  The  following  state-space  is  the  full  plant  including  amplifier 
%  and  sampling  delay  dynamics 

Afp=[Asd  zeros(l,3);Ba*Csd  Aa  zeros(l,2);zeros(2,l)  Bg*KT*Ca  Ag]; 
Bfp=[Bsd;();0;0]; 

Cfp=[00  Cg]; 

Dfp=0; 


B.5  Weighting,  Disturbance,  and  Noise  Parameters  "param" 

This  M-file  builds  the  state-space  representation  of  the  torque  disturbance  coloring 
filter,  the  sensor  noise  shaping  filter,  and  the  dynamic  weightings  used  in  the  various 
optimal  control  designs.  This  print  out  has  been  edited  to  remove  all  but  the  1st  order 
weighting  Ws  used  in  the  final  azimuth  axis  unity  feedback  design. 

M-File  param: 

%  param  -  Parameters  for  disturbance,  noise,  and  weightings. 
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%  Torque  Disturbance  distribution  vector 
gam=[l;0]; 

%  Disturbance  state-space  where: 

9c  -1 

9c  Wd(s)  =  Cd(sl-Ad)  Bd  +  Dd 

9c  Disturbance  parameters  used  in  optimal  control  for  performance  robustness 

Gain=1000; 

wb=l; 

numd=Gain*wb; 
dend=[  l  wb]; 

[Ad,Bd,Cd,Dd]=tf2ss(numd,dend); 

9c  Disturbance  parameters  used  in  simulation 

Gain=1000; 

wb=l; 

numd=Gain*wb; 
dend=[l  wb]; 

[Adsim,Bdsim,Cdsim,Ddsim]=tf2ss(numd,dend); 

9c  Sensor  Noise  parameters  used  in  simulation 

Gain=l; 

wbl=50; 

wb2=50; 

numn=Gain*wbl*wb2; 

denn=conv([l  wbl],[l  wb2]); 

[Ansim,Bnsim,Cnsim,Dnsim]=tf2ss(numn,denn); 

9c  Sensitivity  weighting  state-space  where  Ws  is  First  Order 

Gain=5000; 

wbl=.0001; 

numws=Gain*wb  1 ; 

denws=[l  wbl]; 

[As,Bs,Cs,Dsj=tf2ss(numws,denws); 

9c  LQG  weightings 

p7_  1  . 

H=[  l’o  ; 0  1  ]; 


B.6  Building  the  P  matrix  "pbazswl5" 

This  M-file  calls  the  M-files  azplant  and  param  to  build  the  state-space  form  of  the 
azimuth  axis  model,  the  torque  disturbance  and  sensor  noise  coloring  Filters,  and  the 
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weightings.  Then  it  builds  the  P  matrix  and  defines  the  dimension  of  P  necessary  for  the 
H2  optimization  algorithm. 

M-File  d  baz.swl5: 

%  pbazswl5-  Azimuth  Axis  P  Matrix  Build 
%  Unity  feedback  setup 

%  Build  state-space  azimuth  axis  plant 
azplant 

%  Disturbance,  noise,  and  weighting  parameters 
par  am 

%  Nine  matrices  that  make  up  the  state-space  of  P(s) 

A=[Ap  gam*Cd  zeros(2,l);zeros(l,2)  Ad  0;Bs*Cp0  As]; 

Bw=[zeros(2,2);Bd  0  ;0  Bs]; 

Bu=[Bp;0;  0]; 

Cz=[H  zeros(2,2)  ;zeros(l,4);zeros(l,3)  Cs]; 

Dzw=[zeros(4,2)]; 

Dzu=[zeros(2,l);  Rz;0]; 

Cy=[Cp  0  0]; 

Dyw=[0  1  ]; 

Dyu=[0]; 

% 

P=[A,Bw,Bu;Cz,Dzw,Dzu;Cy,Dyw,Dyu]; 

% 

%  Define  the  dimensions  of  P  where 
%  dims=[ns,nw,nu,nz,ny] 

%  ns  -  number  of  states 
%  nw  -  number  of  inputs  w 
%  nu  -  number  of  inputs  u 
%  nz  -  number  of  outputs  z 
%  ny  -  number  of  outputs  y 
[m,n]=size(A); 
ns=m; 

[m,n]=size(Bw); 

nw=n; 

[m,n]=size(Bu); 

nu=n; 

[m,n]=size(Cz); 

nz=m; 

[m,n]=size(Cy); 

ny=m; 

dims=[ns,nw,nu,nz,ny]; 
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B.  7  Hi  Optimization  "H2  " 


This  M-file  calls  the  M-files  h2opt  and  split  to  calculate  the  H2  optimal  controller 
and  split  the  controller  into  its  state-space  form. 

M-File  H2 

%  H2-  H2  Optimization 

[Pc,su,sy,Kc,Kf]=h2opt(P,dims); 

ns=dims(:,l); 

[Ac,Bc,Cc,Dc]=split(Pc,ns); 


B.8  H 2  Optimization" h2opt" 

This  M-file  calculates  the  H2  opumal  controller. 

MzEk./i2opt 

function  [pk,su,sy,kc,kf]  =  h2opt(p,dims) 
%[pk,su,sy,kc,kf]=h2opt(p,dims) 

ns  =  dims(l);nw  =  dims(2);nu  =  dims(3);nz  =  dims(4);ny  =  dims(5); 
[a,b,c,d]  =  split(p,ns); 

[d  1 1,dl2,d21,d22]  =  split(d,nz,nw); 

if  any(any(dl  1  ~=  0)),  error('dl  1  not  a  zero  matrix’);end; 

if  any(any(d22  ~=  0)),  error('d22  not  a  zero  matrix');end; 

[pscl,su,sy]  =  scale3(p,dims); 

[a,b,c,d]  =  split(pscl,ns); 

[d  1 1,dl2,d21,d22]  =  split(d,nz,nw); 

bl  =  b(:,l:nw); 

b2  =  b(:,nw+l:nw+nu); 

cl  =c(l:nz,:); 

c2  =  c(nz+l:nz+ny,:); 

f  =  a  -  b2*dl2’*cl; 

g  =  b2*b2'; 

clhat  =  (eye(nz)  -  dl2*dl2')*cl; 
h  =  clhat'*clhat; 
x2  =  are(f,g,h); 
f  =  (a  -  bl*d2r*c2)’; 
g  =  c2'*c2; 

blhat  =  bl*(eye(nw)  -  d2r*d21); 

h  =  blhat*blhat'; 

y2  =  are(f,g,h); 

kc  =  b2'*x2  +  dl2’*cl; 

kf  =  y2*c2'  +  b  1  *d2 1 

ak  =  a  -  kf*c2  -  b2*kc; 

bk  =  kf*sy; 

ck  =  -inv(su)*kc; 

dk  =  0*ones(nu,ny); 
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pk  =  [ak,  bk;ck,  dk] ; 


B.9  Frequency  Responses  "sentoteval" 

This  M-file  calculates  the  open  loop  Bode  frequency  response  and  gain  and  phase 
margins  of  -Gp(s)Gc(s).  It  also  calculates  the  closed-loop  transfer  function  and 

the  torque  disturbance  rejection  transfer  function  by  calculating  the  closed-loop  linear 
model  of  the  Simulink  model  "SimSenTotEvalMod". 

M-File  sentoteval 

9c  sentotaleval  -  Total  Evaluation  Model 
%  Gain  and  Phase  Margins 

9c  Closed-Loop  and  Torque  Disturbance  Rejection  Transfer  Functions 

%  Frequency  range  for  all  analysis 
w=logspace(-2,3,300); 

%  Calculate  the  SISO  gain  and  phase  margins 

9c  where  Aol,  Bol,  Col,  &  Dol  is  the  open  loop  state-space  of  -Gp(s)Gc(s) 
[Aol,Bol,Col,Dol]=series(Ac,Bc,Cc,Dc,Afp,Bfp,Cfp,Dfp); 

9c  Since  feedback  is  positive  the  margins  are  obtained  from  -GcGp 
[magol,phaol  ]=bode(Aol,Bol,-Col,Dol,  1  ,w); 

(GM,PM,wg,wp]=margin(magol,phaol,w); 

margin(magol,phaol,w) 

9c  Set  up  for  transfer  function  calculations,  null  out  Filters 

9c  and  calculate  linear  model 

Ansim=[); 

Bnsim=[|; 

Cnsim=[); 

Dnsim=  1 ; 

Adsim=[]; 

Bdsim=[]; 

Cdsim=[j; 

Ddsim=  1 ; 

(Acl,Bcl,Ccl,Dclj=linmod('SimSenTotEvalMod'); 

9c  Torque  disturbance  rejection  transfer  function 
(magds,phadSj-bode(Acl,Bcl,Ccl,Dcl,l,w); 
magds=2()*log  lO(magds); 

9c  Closed-loop  transfer  function 
9c  Complimentary  Sensitivity 
[magns,phans]-bode(Acl,Bcl,Ccl,Dcl,2,w); 
magns=2()*log  lO(magns); 
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Appendix  C:  Simulab  Block  Diagrams 
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Appendix  D:  SBD  Controller  Design  and  Simulation  Tutorial 


The  following  is  the  sequence  of  steps  taken  to  design  the  azimuth  axis  H2  optimal 
unity  feedback  controller  and  perform  Simulink  simulations. 

1.  Build  the  azimuth  axis  nominal  and  truth  state-space  models  by  typing 
azplant  in  the  Matlab  workspace. 

2.  Build  the  torque  disturbance  and  sensor  noise  coloring  filters,  and 
weightings  in  state-space  form  by  typing  param. 

3.  Build  the  P  matrix  by  typing  pbazswl5. 

4.  Calculate  the  H2  optimal  controller  in  state-space  format  by  typing  H2. 

5.  Calculate  the  Bode  frequency  response  and  gain  and  phase  margins  of 
-Gp(s)Gc(s),  the  closed-loop  transfer  function  0(s)/0c(s),  and  the  torque  disturbance 
rejection  transfer  function  by  typing  sentoteval. 

6.  Perform  simulations  with  the  Simulink  model  "SimSenEvalMod".  The 
Simulink  model  was  built  mostly  with  state-space  blocks  such  that  the  parameters  for 
those  blocks  are  automatically  read  in  from  the  Matlab  workspace. 

a.  Simulations  were  performed  with  the  maximum  and  minimum  step 
sizes  set  at  0.005  sec  to  correspond  to  the  200  Hz  sample  rate  of  the  SBD.  The 
integration  algorithm  used  was  Linsim. 

b.  Ramp  and  Ephemeris  command  tracking  simulations  were  performed 
by  using  the  "From  Workspace"  block  to  load  in  the  command  vector.  The  data  for  all 
the  command  vectors  are  stored  in  the  MAT-file  poscmd.  The  5  and  10  second  ramp 
command  vectors  are  called  poscmdfivse cramp  and  poscmdtensecramp ,  respectively. 

The  5  second  ephemeris  command  vector  is  called  poscmdascend. 


D-l 


Appendix  E:  Full-Up  Simulation  Plots 
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Figure  E-4  H2  Controller  Voltage 


Figure  E-5  Current  Controller  Voltage  PSD 
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